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I S.  Abstract 


This  Lecture  Series  No. 82,  on  the  subject  of  Practical  Aspects  of  Kalman  Filtering 
Impdcmentatio!’.  'v;f>  infended  to  emphasise  the  practical  aspects  of  the  use  ol  optimal 
filters  in  guidance,  navigation  and  control  systems.  All  of  the  Lecturers  for  this  Series 
have  many  years  of  experience  in  the  field,  and  they  relate  tlieir  c.xpcriences  on 
various  projects  involving  implementation  teehni'jues  and  problems  with  optimal 
filters.  Lecture  Series  No. 82,  aims  to  provide  an  account  of  how  optima!  filters  are 
actually  designed  and  iiiiplenicnted  in  practice.  Tl’.e  techniques  should  be  applicable 
to  a wide  variety  of  situations. 
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FOREWORD 


This  Lecture  Series,  No  8 J.  on  the  Practical  Aspects  of  Kalman  Filtering  Implementation  is  sponsored  by  the 
Guidance  and  Control  Panel  of  AOARO  and  organized  by  the  Consultant  and  Exchange  Program. 

The  development  of  the  Kalman  filler  in  the  early  I960's  removed  from  the  Wiener  filler  approHch  the  as-sumpiions 
of  stalionarity  and  the  availability  of  an  infint'e  lime  inleival  of  data.  The  solution,  in  the  lorm  ol  a rceursive  computer 
algorithm,  made  study  and  analysis  of  its  application  to  guidance  and  control  a relatively  siiaighlforward  matter 
Early  hardware  implementations  at  the  Charles  Stark  Draper  Laboratory,  Autonelics,  and  elsewhere  validated  the 
conceptual  framework  and  praetiealily  of  the  filter  implementation  for  a variety  of  problems. 

In  actual  practice,  however,  oonsiderable  experience  is  meded  when  the  f|"'*slions  of  modelling,  design,  and 
implementation  are  considered.  Each  of  the  lecturers  brings  to  this  scries  a depth  of  experience  that  was  gained 
by  “hands  on"  development  of  filters  that  work  with  hardware. 

The  emphasis  thruugiiout  the  Lecture  Senes  is  on  developing  praciicil  approaches  to  ‘.he  developmeni  of  filters 
which  lead  to  satisfaetorv  system  performance,  where  “satisfactory"  is  defined  by  the  design  engineer.  “Satisfactory” 
is  used  instead  of  “optimal"  because,  as  each  of  the  lecturers  points  out.  the  optimization  of  a particular  filter 
mechanization  generally  includes  many  factors  that  are  difficult  or  impossible  to  describe  niatheniatically.  such  as 
tnc  tradeoff  between  computer  requirements  and  performanc-e  of  the  filter.  The  techniques  and  approaches 
described  should  be  app'ica^iv  to  a variety  of  guidance  and  control  problems. 


Dr.  George  T.SCIIMIDT 

The  Charles  Stark  Draper  Laboratory,  Int. 

Cambridge,  MassaehuK'lts. 
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Ommnary 

ExpeMsacM  In  th«  davalopmant  and  taat  aTaluailoo  rt  Kalmao  (Utera  In  alr<ad  navlxatloa  ayatama  for  aircraft 
ara  praaontad.  Liaalgna  for  two  operational  ayitama  for  an  route 'catrigaHo  i>an*  aixl  two  axperltnental  ayatama  for 
lurui!...!  atw.  miJ  iaoulug  ua«a  all.  aaauiiua.1.  TUa  iMliuat.  I*  ‘.U.  den!op'«on)>l  vp^rmch  uaad  with 

•xamplaa  from  the  actual  dealfna.  Practical  cooalderattooa  ara  atiwaaed  rather  than  the  mathematloal  focrnulaiiona 
and  theory.  Drtalle  ara  preaanted  oe  t'ja  aquara-root  Implemeotatloa  of  the  Kalman  filter  which  la  uaed  In  three  of 
the  actual  ayatoma.  Problems  •acotiotered  In  actual  dealgna  and  the  aolutlooe  selected  for  these  problems  are  dla- 
cuaaad.  A brief  orerrlew  of  the  poealble  future  treitda  In  aircraft  naelgatloe  ayatems  le  also  given. 


1.  Introduction 


This  lectu'o  presents  the  author's  experlancea  in  the  development  of  Kalman  filters  for  combining  external 
Onavald)  meaeurementa  with  an  loerttal  navigation  ayetem  to  form  an  "aided"  INS  for  a Ire  raft -navigation  purposes. 

This  experience  Inchidee  decigna  for  two  oparallonal  syatema  for  enroute-iutvlgatlon  uae«  and  deelgne  for  eevtral 
e.xperlmantal  ayatems  for  terminal-area  and  taodlng  uses.  Theao  designs  have  bean  made  over  the  past  10  years, 
durtiv  which  airoome-computer  technology  hae  advanced  tremendously.  These  advances  In  computational  capabltiiles, 
•long  with  advances  In  theory,  have  provided  for  the  design  Improvameots  which  are  dlscuaaed.  The  tnenlal  aanalng 
(ievlcet  uaed  In  ibe  deeigna  have  corered  ras^^p  from  hlgh-accuracy  plalform-t>pe  Inertial  meaeurement  unlia  (IMU; 
to  very  elmplo  low-accuracy  etrappod-doap  scoaora. 

The  lecture  Keg(i.«  with  a brief  overview  of  aided  Inertial  navigation  eyatema.  C'haracterlstica  are  dlecuased 
which  aru  relevant  to  the  subaoquent  material,  and  this  le  followed  by  the  main  topic  covering  the  de**olopmoc.t 
approach  used  with  extitiplea  from  the  actual  deeigna.  Some  problems  which  have  been  experienced  In  actual  syatema 
are  atao  described.  The  lecture  concludes  with  e brief  overview  of  the  poealble  future  trunda  In  aircraft  navigation 
eyaiem* . 


g.  Overview  of  Aided  Inertial  .Navtgatore 

Figure  1 le  a highly  simplified  block  diagram  lUustratiog  the  fundamenial  operation  of  ona  type  of  Inertial 
navigation  ayatem.  Thi  principal  components,  ihe  inertial  measurement  unit  (I.MU)  and  iba  computer,  are  shown. 
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Th«  IMU  contains  a itablo  platform  on  whtoh  three  Kyros  and  throe  linear  acceloromotera  are  orthogonally 
mounted.  Ah  lmplle<l  by  its  name,  the  atablo  platform  maintains  un  orientation  commanded  by  the  computer,  which 
Is  Independent  of  the  orientation  of  the  case.  This  Is  accomplished  as  Indicated  In  Klguro  1 by  senBing  error  signals 
from  the  gyro-output-axla  plokoffs  and  through  feetibaok  providing  the  appropriate  platform-drive-nulling  torques. 
This  Inner-loop  feedback-control  system  must  have  sufftolont  gain  and  dynamic  response  to  keep  the  plckoff  errors 
small,  regardless  of  IMU-case  attitude  mattons. 

If  the  Inner  loop  functions  properly,  then  the  platform  maintains  ihe  orientation  commanded  by  the  computer. 
Each  gyro,  however,  Is  an  Imperfect  device  and  tends  to  exhibit  a small  drift  role.  That  Is,  even  though  the  gyro 
output  axis  Is  nulled,  the  gyro  case  (flxo<l  to  the  platform)  Iws  a rotation  rate  about  the  input-axis  direction,  which 
differs  slightly  from  the  command  rate.  Those  drift  rates  arise  because  of  Internal  rotnllonnl  Imbalances  In  the  gyro, 
torquer-scale-faclor  errors,  and  from  several  other  more  subtle  mechanisms,  Esllmatos  of  these  drift  rates  can 
bo  used  to  minimize  their  effect  on  platform  orientation  by  applying  appropriate  comp«;n8atlng  signals  to  the  gyro 
torque rs. 

As  Indicated  In  Figure  1,  the  accelerometer  outputs  are  the  measured  specific  forces  which  are  sent  to  the 
computer  in  the  form  of  a pulse  train  or  the  sum  of  pulses  over  u specific  time  Interval,  The  specific  force  vector, 
f,  ts  given  as 

f - * a - g 

where 

a = the  Inertial  acceleration  vector 

g = the  gravitational  attraction  per  unit  mass 

If  the  position  is  known,  then  g can  bo  calculated  to  a high  degree  of  accuracy.  The  navigation  equations  calculate 
the  acceleration  from  the  measured  specific  force  ami  the  calculated  gravity,  and  doubly  Integrate  these  accelerations 
for  position.  These  calculations  arc  exocule<l  at  a sufficiently  high  rate  that  the  ixisltlon  and  velocity  are  continuously 
available  (for  nil  practical  purposes). 

To  initialize  o()cndlons,  the  system  must  l>c  aligned  so  that  the  coordinate  frame  nf  the  comiaiier  and  the  pint- 
form  are  coincident,  and  the  Inlllnl  i)oattlon  and  velocity  must  bo  Inserted  Into  the  iipiiropriato  cells  of  the  coni|nitef. 

The  stable  platforms  for  most  aircraft  navigation  systems  are  contmande<l  to  stay  level  with  resi>oct  In  the 
local  vertical.  This  moans  that  two  of  the  axes  He  In  the  locally  level  plane  ami  the  third  axis  lies  along  the  vertical 
plane,  the  navigiitlon  equations  solve  for  the  velocity  with  respect  to  ihe  earth  (rather  than  Inertial  velocity)  In  the 
moving  coordinate  frame,  which  stays  in  the  locally  level  orientation,  A frequently  used  set  of  navigation  equations 
are  referred  to  a wander-azimuth  geodetic-vertical  mechanization.  Wamicr  azimuth  means  that  no  att(>mpt  is  made 
to  keep  the  azimuth  of  a level  axis  in  any  preferred  direction  such  as  north.  The  azimuth  gyro  is  tnrqued  with  the 
computed  vertical  component  of  earth  rate  in  such  a manner  tluat  the  level  frame  remains  fixed  with  respect  to  the 
earth  when  the  aircraft  is  stationary. 

The  stable  platforni  's  initially  allgnctl  by  first  driving  it  (with  ihe  torquers)  until  the  iwii  level-aceelefomcter 
ouqjuts  are  zero,  (ir.ce  U has  been  leveled.  Us  azimuth  with  resitcel  to  north  Is  delormined  by  moniKiring  the  level- 
gyro  command  rates  which  arc  necc.isary  to  keep  the  platform  level  in  the  (iresenee  of  ihe  rotation  rate  of  the  earth. 

Platform-type  Inertial  navigation  systems  are  in  widespread  use  IrHiay  for  Ixith  military  and  commeivial  air- 
craft. The  commercially  available  systems  have  error  charade ristics  which  grow  from  alignment  at  about  1 
■autlcal  mile  per  hour.  This  error  growth  is  primarily  caused  Ipv  gyro  drift  rates  that  are  not  piropcrlv  comiH  O ! 
for  In  the  computer.  The  vertical  channel  in  these  systems  is  either  clamped  (that  is,  not  iisedl  o,  a t'aromdrii- 
altimeter  is  used  as  an  altitude  reference  for  stabilizing  the  vortical  channel. 

Figure  2 shows  a sample  run  of  a free  Inertial  navlg.atlon  system  in  Ihe  laboratory.  The  system  was  aligned 
for  nt)Out  If)  minutes  prior  to  starting  the  system  in  the  navlg.atlnn  mode.  The  error  growth  with  time  's  evMi'nt  In 
these  results. 

• 

Figure  i)  shows  the  inertial  path  as  computed  by  the  free  Inertial  system  versus  the  (losition  comput  'd  from 
the  multiple-station  DMK  measurements.  In  this  Instance,  the  navigation  system  was  aligned  al  |xiint  1 on  1- ig\ire 
•T  while  the  aircraft  was  stationary.  The  aircraft  then  l(X)k  off  and  flew  the  |>alh  close  to  that  Indicated  by  the  DMK- 
derivcfl  (xiaitlon.  The  aircraft  flew  f>ver  the  starting  point  at  the  end  of  the  nin,  which  al  least  is  a onc-point  check 
of  the  PiMK  [losition  accuracy.  As  may  t)c  noteil,  the  deviation  l)etwecn  the  two  paths  grows  with  lime  from  initiali- 
zation. 

Error  growths  of  1 nautical  mile  per  hour  .are  certainly  tolerable  for  many  onroute-nnvlgation  purposes. 

They  are.  however,  completely  unacceptable  for  terminal-area  and  landing  purposes.  The  traditional  approach  to 
solving  prfililerns  like  this  is  'o  hav<!  a separale  navigation  system  for  each  phase  of  flight;  for  I'xample,  we  couhl 
use  a miiltlple-DMF  solution  for  the  [msltlon  reference  during  enroulo  and  terminal-area  iihases.  On  final  approach 
w"  f oulfl  'ise  the  (I  S for  the  refttrcnoe.  With  such  a mechanization  there  Is  no  need  for  Ihe  INS,  as  long  as  the  alr- 
'■raft  nil's  In  arcrin  where  the  mulll[)le-r)MK  measurements  arc  [Ktssltde. 

In  f'-ei  nt  yearn,  military  uses  have  risiuired  accurnlo  nnvigatlon  during  oorirxls  when  no  I'xtornnl  riavlds  are 
e,  illatde.  ,H  well  :m  are  iir.ite  navigation  for  long  ['erlofls  of  flight.  The  free  Inertial  navigation  systems  emihl  not 


M 


Mtlsiy  th*  requtr«m«nU,  >o  klded  mivlgatton  lyitemi  came  Into  existence.  For  example,  the  first  systems  were; 

(1)  Doppler-lnertlal, 

(2)  loran- Inertial. 

(3)  stellar-lnertlal. 

Generally,  these  tlrsl  systems  had  simple  algorithms  for  combining  the  Inertial  data  with  the  navald  measurements, 
ainoe  the  airborne  computational  capabilities  were  quite  limited.  Kalman  filtering  was  introduced,  and  airborne 
digital  computational  oapabllltles  Improved  substantially  In  the  early  1960's.  These  two  events  have  led  to  far  greater 
sophistication  of  the  algorithms  In  aided  Inertial  navlgstlon  systems. 

Figure  4 Is  a simplified  block  diagram  of  an  aided  Inertial  navigation  system  for  a platform-type  IMU.  The 
system  Is  mechanized  such  that  the  estimated  state  Is  calculated  (t.e. , updated)  at  a moderately  high  frequency  (10 
to  40  Hz).  The  Kalman  filter  uses  the  navald  measurements,  along  with  the  estimated  state,  to  estimate  the  error 
state.  The  error  state  Is,  In  turn,  used  to  correct  the  estimated  state.  This  process  of  estimation  and  correction 
la  done  at  a considerably  lower  frequency  (frem  0,017  Hz  to  1 Hz  In  the  designs  the  author  has  Implemented). 
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f = compensated  accelerometer  data  In  computer  frame 

w - desired  platform  rate 

c 

= compensated  platform  command  rate 
x(t)  = estimated  state 

dx  = Incremental  state  LStImated  by  the  niter 
yft)  ' vector  of  measurements  from  the  navigation  aids 
Figure  4.  Block  digram  of  an  Aided  Inertial  Navigation  System 


The  prlmr.ry  ob)octlvo  of  this  lecture  is  to  show  oxporloncos  with  design  and  tests  of  such  aided  Inertial  naviga- 
tion systems.  Before  doing  this.  It  Is  pertinent  to  consider  what  the  error  characteristics  of  a properly  designed  aided 
system  sho*ild  bo.  First,  In  the  presence  of  navlgutlon-ald  nicasuromonts  the  error  In  the  estimated  state  should  never 
bo  worse  than  that  f)f  the  measuring  device.  For  example,  If  wo  wore  using  DME  to  aid  the  Inertial  navigation  system 
and  ’.ho  DME  error  were  around  500  feet,  then  the  system  errors  should  bo  of  t'.j  order  of  500  foot  or  loss.  In  tho 
abscri'v-  '<!  navald  meaauromonts,  (ho  error  In  tho  estimated  state  will  grow  In  accordance  with  tho  free  Inertial 
charm ■'  'itics.  The  rate  of  error  growth  depends  on  (he  filter  design  and  tho  error  characteristics  ol  the  IMU.  Tho 
more  soplilstlcatcrl  Miters  estimate  the  parameters  such  as  steady  gyro  drifts,  tilt  errors,  and  so  forth.  With  such 
•v/sfems  (he  Inertial  system  enters  tho  free  Inertial  mode  In  a well-calibrated  condition.  If  the  real  error  sources 
are  deterministic,  then  tho  rate  of  error  growth  during  the  free  Inertial  mode  can  bo  very  small. 


StperloDOeg  In  Fllt<.<r  Deeigp  und  Vgllrlatton 


3, 


Thle  bectlon  ;.renr^ntB  trtaterlal  In  the  general  chronological  order  of  filter  development  that  had  been  experienced 
by  the  writer,  Examples  Ti-om  several  s\aterca  and  su.^geetiona  based  on  expi  rtence  are  Included.  An  attempt  is 
made  to  describe  the  highlights,  the  problem  areas,  and  the  solutions  which  ha'  ' Seen  used  In  tbeae  Byatems.  The 
principles  and  practical  considerations  are  emphasised  rather  than  the  matheme'tcal  formulations  and  theory. 


t I 


! t 


3.1  Overview  of  the  design  problem.  One  ol  the  most  Important  t.  ctore  In  the  design  o»  Kalman  filters  la  In  ob- 
lalniug  a complete  understandlig  of  the  overall  piobtom.  One  invariably  atarta  vi’.h  a knowledge  of: 


(1) 

The 

performance  objective?  or  requirements. 

r- 

# 

(2) 

The 

constraints  on  the  equipment.  For  example. 

\ 

f 

(a) 

The  IMU  may  be  specified. 

fc 

(b) 

The  computer  may  t>e  specified. 

A 

(c) 

The  navaid  references  (maaeurement  devices) 

% 

1 

(3) 

The 

desired  modes  of  operation.  Kcr  axamplo. 

(a) 

Ground  alignment. 

s' 

(b) 

Air  alignment  (air  start) 

<e) 

Barometric  altitude-inertial. 

(d) 

■Tacan-lnertlal. 

(e) 

Stellar-Inertial. 

1 

(f| 

1L3-Iaertlal  (for  landing). 

/. 

(4) 

Whether  the  system  Is  to  be  automatic  or  a navigator  ! 

'f 

(5) 

The  development  schedule. 

In  the  devtiopment  of  the  CSA  aircraft  navigation  syatem  we  had  relevant  information  on  each  of  the  items 
shown  In  Figure  S Cli.  Generally  speaking,  one  starts  with  a simple  functional  diagram  as  ahowT  in  Flguro  S,  .".long 
with  all  of  the  available  information  on  each  of  the  devices  and  the  cieeigc  objectives,  and  onu  perforins  a prellmluary 
design.  This  preliminary  design  focuses  a good  deal  of  attention  on  the  constraints  Imposed  by  the  dlglul  computer, 
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For  ezimplo,  the  navigation  fiinctlom.  aaaoclated  with 


(1)  Brlngtng  all  data  Into  the  computer. 
(2;  Serrlotng  the  dlaplay  panel. 

(3)  Solvli^  the  navigation  equaMooa. 


(4)  Servlolng  the  platform. 

may  require  a algnlfloaot  amoiiat  of  the  available  memory  and  real  time  of  the  computer.  If  the  computer  muet  aleo 
execute  guidance  and  control  logic,  then  evea  more  memory  and  real  time  Is  used  (or  necessary  functions  other  than 
filtering.  The  preliminary  dastgn  allocates  memory  and  real  time  to  each  of  the  functions  to  be  executed  (n  the  air- 
borne computer.  Quite  obviously,  the  percentage  of  real  time  and  memory  allocated  to  the  Kalman  filter  can  have  a 
strong  Influence  on  tbe  filter  design. 


In  developing  the  preliminary  dealgn  for  tbe  filter  one  must  select; 
(ll  The  number  of  state  variables. 

(2|  The  number  of  meavurementa. 


(3>  Which  measurements  at  any  time  period  (or  model  are  to  be  used. 


(t)  The  filter  cycle  times,  and  eo  forth. 


This  selection  must  satisfy  the  memory  snd  real-time  cooetralnts  of  the  airborne  computer  and  satisfy  the  accuracy 
requirement  i of  the  bpeclflcatlons. 

To  the  author's  knowleilge,  there  la  no  straightforward  design  procedure:  rather,  one  usee  a cut-and-try 
approach  based  on  pas:  experience  and  ensemble  error  an<>lyate  (If  available)  tc  give  a tentative  design. 

Id  reU'.mg  machine  time  to  nurabei  of  measurements,  cycle  times,  and  number  of  state  variables,  the  equations 
In  Ileference  Dz]  are  useful  for  preliminary  dealgo  purposea.  For  tbe  square-root  covariance  I filter,  the  reference 
glvtKt; 


ai 

Number  of  multiplies 

lOo^ 

6 

3 

(2) 

Number  oC  adds 

6 

<31 

Number  of  square  roots 

= n + r 

0) 

Number  of  divides 

* n + 2r 

(3r  + m + 1)  + n (4r  + m ♦ - ) -t  2r 
o 

(3r  ♦ ro  - |>  ♦ n (r  ♦ |)  ♦ r 


where 

1)  = miQiber  of  state  vs'tablee 
m - number  of  random  forcing  functions 
r number  of  meaeurements 

We  take  as  au  oxampla  a platform  syateni  with  a threo-axb-  Kslimin  filter  and  messurements  conslatlog  of 
TACAN  range  sod  bearing  plus  baronuttrlo  altitude.  We  assume  toe  following  state  variables  are  estimated  by  the  filter: 

(1;  Three  compooerta  of  poeltion, 

(2)  Three  components  velocity. 

(3)  Three  oompo^nts  of  platform/cumputcr  mlsa''gnmetit  (tilts). 

(4)  Three  componeato  of  gyro  drifts. 

(5)  One  component  of  vertical  acceleration  blae, 

(6)  Three  compononts  of  measu'-ernent  calibration. 

T!m  last  seven  etato  varlsbion  nre  &ssumed  ‘.o  bo  treated  ae  exponentlBlly  corrclalod  noise  In  the  filler. 


To-  the  example  a 16,  m ^ 1,  sud  r ~ Ve  also  assume  that  this  particular  computer  has  the  following 
Umee  lor  lh«  oporati<«s  to  mU  rossootjiIa, 
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(1)  Multiply  “24 

(2)  Add  ^ 6 

(S>  Square  root  = zoo 

(4)  Divide  24 

The  equatlooa,  aloi>2  »lth  the  computer  Mruroptloaa,  give; 


Number 

Ehcecutlon  time 
(milliseconds) 

multiplies 

U.510 

276.240 

adds 

10.SS9 

65.154 

»t?jare  roota 

19 

3.  fa 

dtvUes 

, . f 22 

3.S28 

o»;  rhiM/J  (for  Indexing,  etc.) 

85.154 

TOT.4L 

410, C7 8 

The  overhead  used  depeoda  on  Um  eoioputer  inetructlnd  capabilitlce.  A time  equal  to  the  add  time  has  been 
reasonable  for  the  computers  used  > j the  autl/or. 

Tbe  total  time  (410.876  mllUeecoodel  la  the  eatlmato  of  the  exocuiloa  lime  If  all  calculi.tlooa  are  executed 
aequeutlallr.  Other  calculations  take  priority  ever  the  filter.  If  the  filter  were  allocated  20  .jerceot  real  time  for 
this  problem,  .hen  tbe  filter  could  be  cycled  every  2.0544  eecoodo.  ll  the  measuremonte  are  to  be  accepted  at  a 
higher  rate  'n  <t. , lO  Hs),  thon  we  must  Introduce  data  averaging  (preprocessing  log  o)  or  simplify  the  filter  sub* 
atantlally. 

This  type  of  Information,  along  with  tbe  available  frequency  of  the  oavald  data,  which  Is  frequently  high  (e.g. , 
40  Ht  for  elevation  data  from  the  microwave  landing  eyatem  (MLS)).  lUustrates  the  practical  problems  of: 

(1 1 What  data  ebould  be  accepted  ? 

(2)  Should  preprocessing  (e.g. , simple  averaging)  be  used  so  that  all  data  can  be  accepted? 

(3)  What  minimum  frequency  o(  filter  cycling  Is  required? 

These  type  of  problems  have  to  be  resolved  In  the  design. 


3.1  Navigation  Equations.  The  navigation  equations  rccept  raw  accelerometer  data  and  calculate  poeitlou,  velocity, 
and  platform-control  torques.  In  tbe  aided  eystems  discussed,  tbe  navigation  equations  are  used  to  keep  the  best 
estimate  of  the  slate  current.  This  means  that  the  form  of  the  navigation  equations  has  to  allow  tbe  estimated  error 
state  to  be  Introduced  atxl  correct  the  estimate.  The  error-slate  vector  for  a three-axle  Implemertatlon  will  have  at 
least  10  components: 

fl)  Three  position  errors. 

(2)  Threi  .eloclty  errors. 

(3)  Three  plstform/computer  mlsallgmcent  angles  (tilts). 

(4)  One  vertical  acceleration  bias. 

The  position,  velocity,  arid  acceleratlon-blaa  estimates  are  carried  In  registers  In  the  computer  so  that  there  Is  never 
a problem  In  adding  estimated  errors  lo  the  state.  The  lllta  are  not  immeillstely  changed,  unless  the  navigation  equa- 
tions are  mechanized  In  a manner  which  permits  this  change.  Figure  6 Is  a block  diagram  of  the  type  of  mechanlratloo 
which  provides  for  compensation  of  tho  dominant  error  sources  of  a platform  IMU,  Including  tilts.  1he  accelerometer 
outputs  are  compensated  for  bias,  scale  factor,  and  mlsallgntnenis  before  compensation  for  tilts.  Ihe  output  of  the 
compensstluQ  la  tbe  specific-foroe  vector  uoed  by  the  navigation  equations.  The  computed  platform  rate  required  to 
keep  tbe  platform  level  Is  compensated  tor  tilts  followed  by  ecsle  (actor  and  mlsallgnmants,  steady  drifts,  and  drifts 
due  to  mass  unbalance  (g-dependent  drifts).  The  meebaoitation  shown  permits  a leveling  rate  to  drive  tbe  estimate  of 
tilts  to  zero  without  having  say  Influence  on  tbe  navigation  or  estimation  results.  This  type  of  tuechaQlzatlon  has  tho 
foUowlng  advantages: 

(1)  The  linearization  seaumpttons  embodied  In  the  filter  algorithm  are  less  prone  to  cause  problems. 
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Figure  6.  Block  Diagram  of  Software  Componaatlon  for  IMU  Anomalies 


(2)  Control  for  platform  leveling  Is  completely  Independent  of  the  estimation  problem.  Estimates  of 
state  changes  due  to  the  leveling  control  need  not  be  carried  by  the  filter  while  the  platform  Is  being 
leveled, 

(3)  The  conceptual  "errorless  navigator"  Is  a perfectly  compensated  real  platform  rather  than  an  Ideal 
errorless  platform.  This  modeling  simplifies  (at  least  conceptually)  the  development  of  error  models 
for  the  Kalman  fUter, 

This  mechanization  has  been  Implemented  In  two  of  the  systems  the  author  has  developed.  Its  only  disadvantage 
Is  a small  Increase  in  the  memory  and  real  tfme  required  by  the  navigation  equations  In  the  airborne  computer. 


3.3  Systems  Modes.  An  aided  INS  for  airborne  uses  must  generally  have  the  following  modes; 

(1)  Warm-up  and  coarse  alignment. 

(2)  Fine  ground  alignment  (platform  Is  leveled,  heading  estimated,  and  gyro  drifts  calibrated). 

(3)  Aided  navigation  using  the  available  navigation  measurements  in  accordance  with  some  predetermined 
schedule  or  priority  assignment. 

(4)  Airstart  (for  a restart  In  the  air  la  case  of  power  dropout  or  other  causes). 

In  the  systems  the  author  has  worked  on.  Modes  2 and  3 are  very  similar  In  the  filter  Implementation.  The 
prime  difference  is  in  the  type  of  measurement  used  for  the  mode.  For  ground  alignment  a pseudo-measurement  Is 
used,  which  gives  the  information  to  the  filter  that  the  aircraft  Is  stationary  on  the  ground.  For  example,  changes  in 
i-^sltlon  (from  the  input  reference  value)  as  the  accelerometer  data  Is  Integrated  are  attributed  to  tilts,  gyro  drifts, 
and  6c  forth,  in  accordance  with  the  dynamic  error  model  used  In  the  Kalman  filter.  With  such  a mechanization, 
ground  alignment  can  be  terminated  at  any  time  by  simply  removing  the  pseudo-measurements  from  the  filter.  The 
filter  cova  "lance  will  be  properly  initialized  for  subsequent  aided  uses  with  this  type  of  system. 

The  airstart  mode  has  been  implemented  so  that; 


(1) 


The  initial  state  is  set  from  available  measurements  or  inputs.  For  example, 
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(a)  Tba  pUtform  la  ooaraaly  «U(Bad  la  Wval  fitfkt. 

(b)  Platform  haadlag  la  aat  froin  masoatk)  oompaM  p)aa  input. 

(0)  Valoottj  raftatan  ara  ooroputad  from  airgpaad  aad  handing  biformatloo. 

(d)  Tha  poaltlon  rag latara  ara  aat  from  TACAN  and  baromatrlo  altttuda  data. 

(2)  The  Initial  covariance  matrix  la  act  In  aooordaaoe  with  a raaaoaable  error  modal  of  tha  atate  taltlallsa- 
ttoo  uaad  In  Item  1. 

Thta  nyatam  la  then  atarted  lo  tha  aldad  mode  (Mode  3)  and.  If  navald  maaauramaata  ooatlmie,  the  eratam  ooovariaa 
to  a laaaonaMy  aoaurata  oavIvUloa  raferanoa.  If  the  ajmtam  wata  to  enter  a period  of  firaa  iMrttal  operation  (no 
navatda)  right  after  auoh  a atart,  tha  performanoa  would  be  very  poor. 


3.4  Error-atate  Varlaolee.  Tha  error  atatea  for  four  ayetema  the  author  haa  worhed  oo  are  llntad  in  Table  1. 
System  i lathe  CS  navigation  ayntem  described  In  Refereaoe  Cl] . Tbia  ayatem  uses  16  error  ntatea  for  a thrw- 
axta  ImplaoMDtatloa  of  the  aided  navigator.  Of  these,  13  are  used  for  the  Inertial  navigation  errors  md  three  are 
used  for  navaU  calibration. 


Table  1.  Error  States  for  Four  Example  Designs 


SYSTEM  1 


poaltlon  error 

3 

velocity  error 

3 

tilt  error 

a 

gyro  drifts 

3 

acceleration  bias 

1 

Doppler 

2 

atar  tracker 

NA 

elrepeed 
(wtnds  estimated; 

NA 

barometric  altitude 

1 

TACAN 

(range  and  bearing) 

0 

16 

SYHTEM  2 

SYSTEM  3 

SYSTEM  4 

2 

3 

3 

2 

3 

3 

3 

3 

0 

3 

0 

0 

2 

1 

3 

NA 

NA 

NA 

1 

NA 

NA 

3 

NA 

n 

* 

NA* 

1 

1 

0 

NA 

2 

16 

11 

14»* 

I 


1 


% 


i 


¥ 

i 


! 

TP 


j 


i 


*The  vertical  channel  was  Btablltzed  by  a constant-gain  filter  using  oaxometrU  altitude  ae  the  reference.  This  filter 
wae  external  to  the  Kalmao  filter. 

**Thls  system  used  two  Kalman  filters  In  parallel.  The  level  channel  haa  10  error  states  and  the  vertical  obanitel  haa 
four  error  statee. 


System  2 usee  a «Ur  tracker  ae  the  primary  navald.  The  vertical  channel  of  this  mechanisation  Is  stabilized 
with  barometric  altitude  dtta  by  a constant -gain  filter  external  to  the  Kalman  filter.  Here  there  are  12  states  for  the 
level-channel  errcra  of  the  inertial  navigator,  ooe  state  for  calibration  of  the  primary  uaralil,  and  three  atatea  for  lo- 
corpontlng  airspeed  information  loUi  the  Kalman  filter.  Winds  are  estimated  by  the  Kalman  filter  in  this  application. 

System  3 was  an  exporlmeotal  system  [3,  4,  s]  for  potential  us»  lo  autouiaiic  landing.  The  primary  navald 
reference  was  a preclalon  ranging  system  using  three  transpoudera  which  ware  located  at  selected  poeltlona  with 
respect  to  the  runway.  TMe  mechaolzatlon  used  10  error  statee  for  the  three-mxte  Inertial  navigator  and  one  error 
state  for  navald  callbratloa  (bias  In  tba  baromtric  altimeter). 

System  4 la  an  experimental  eystem  for  potential  use  )n  aircraft  landing  cperatlons  where  the  microwave 
landing  eyatem  (MLS)  la  t)vs  primary  reference.  In  (bis  loctanco,  real-time  constralnta  of  the  airborne  computer 
caused  the  filter  to  be  configured  as  10  error  sutea  for  the  level  channel,  and  a separate  (run-ln-parallel)  four- 
error-state  filter  for  the  vertical  channel.  It  haa  nine  error  etatea  for  deacrtbtng  error  of  the  Inertial  reference, 
and  five  error  sts'ea  tor  navald  calibration.  Airspeed  data  is  used  In  the  !e%T<!-chaanel  filter,  so  two  of  the  error 
states  sre  for  eatimaticg  wlnda. 

The  first  three  aystama  all  Incorporate  a higti-uccurscy  plrtform-type  IMU.  System  4 uses  a low-coel 
atrapdowD  reference  IMU  constating  of  directional  and  vertical  gyros  for  aircraft  attitude  and  a triad  of  body- 
mo„.-'*«d  acoelerometera.  Tbe  gyro  and  accelerometer  outputs  are  digitized  by  a 12-blt  A/D  convertor.  The 
accuracy  of  this  Inertial  reference  Is  very  low;  however,  the  MLS  measurements  are  of  high  accuracy  and  almoet 
continuous,  so  the  overall  eystem  accuracy  Is  adequate  for  auiomatlc  landing. 


I 
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Tte  dM)s«  of  all  of  tka  ayatooia  «««  llniltod  in  tha  anaaiMr  cf  (Main  rariaUM  br  tkn  i«al*flaM  or  ■■mw  j 
oeoatralokn  of  tW  alitionM  oomipator.  Tho  parttoola;  orror  atatoo  aaad  «ara  aaiootafl  m UM  boat  notipmoilaa  tar 
fha  partloalar  afylicatloa  of  tka  ayatam.  Soota  otkar  ralafutf  b^ormattoa  oa  tkaaa  a;yntaBio  la  flam  M TaWa  S. 


3. 8 riHar  AlaoHiluna.  Tka  first  aldad  DtS  for  airoraft  aaalcatloa  naaa  aivarlaaoad  bf  tka  aatkor  oaa  bacaa  la 
IMI.  Tka  Biitaaifart  Kaliaaa  flltor  iritk  the  coaarlaaoa  inatris  natal latad  la  tka  oowputar  «aa  taalaaaoaaad  la  tkla 
^sayataw.  Tka  potaatlal  seallaB  protdama  arttk  fiaad'-poliit  arttkmado  lad  to  tka  salaetloa  of  14-klt  fioMtlaB-iMlat  aoft> 
araia  for  tka  f^r.  toaaral  aoaiarloal  probiaBU  vara  aapariaooad  and  "flsM”  ««ra  added  to  proalda  a aatialkcitory 
algorttka.  Tka  aqaarfr*root  algorltkiB  (arKkoot  forcing  fitoctiOM)  waa  davalopad  bjr  M7T  for  tka  Apollo  arataai  la  tka 
aarly  IMO'a.  A fairly  afflclaat  aquara*root  algorltkaa.  Innhiding  random  forcing  fnsotlona.  araa  daaalop^  by  tka 
Mdkor  In  19M  CdJ  : kowpvar,  It  araa  not  nntll  1370  that  tka  algorttkA  oonld  ba  tppliad.  By  tkla  time,  a mora  affiolent 
algcrtthm  aoa  aaallabU  Cl]  and  araa  tkarafora  aalaotad  for  Syatam  3 of  TaMaa  1 and  I. 


TaUa  S.  CharaotarUtto  of  Exaapla  fiystoma 


SraTZM  ! 


SYBTEif  2 


SYBT£M  S 


BY8T5M  4 


Fltlar  algorttkm  EitaiMM  Kalman  Extandad  Kalman  Sstcadad  Kalman 

Borma^  nrlanoa  aqoara-root  oov.  nquaia-root  coa. 


a4aar*“r«ot  cow. 


Compotar  arltkmatlo 


13  bit  -r  algn 
fiaating  poCnt 
aoftwana 


31  bit  + 0^ 
fined  point 


23  bit  + algn 
fined  point 


17  bit  -r-  algn 
fined  point 


Cyola  time 

Maaanramant 

avaraging 

Ifnltlply  apacd 

% real  time 


(Raf.  1) 


oo  aoma  maaa. 


aoftarare  (aloar) 


80  (aao) 


on  aoma  mean. 


12>24  UM 


2 (sac) 


1 (aao) 
oo  all  maaa. 


Storage 

Deralafimaot 

period 


3-3  k 28-blt  words 


ias«<1988 


5.8  k 16-bit  words  3 k 24>btt  words 


1872-1974 


1970-1872 


3 k 18-blt  words 


1974-1878 


TIh  algor itkms  used  la  Systems  2,  3,  and  4 arc,  for  all  practical  purpoeaa.  idantloal  sxoapt  for  minor 
BoJIflcatlons  (or  tba  spaelfie  appileatloc  and  tba  Instruction  rapartolre  of  tba  tliboma  computar.  Tba  s^usra-root 
algorttkffl  naed  for  ikaaa  syntsms  Is  suminsrlted  In  this  ssetlon. 

Tba  timing  and  order  of  calenlstlona  carried  out  In  tba  filter  is  dascribad  with  rafaranoa  to  Flgnro  7,  The 
filter  rafaranoa  time  ts  updated  at  s relstlToly  low  frsqusocy  comparsd  to  tbs  otksr  oiieratloiis  shown. 


flltsr  period 


' (liter  rafaranca  tlmaa 


A • period  of  socapting  maasuremeDts 
A/ffi  '*  psrlnd  at  oarlgntloo  igniata 

Figure  7.  Timing  tor  Fthar  Calculsttona. 


Tka  narlgntlan-aquatloo  update  oooura  at  the  kigkast  (requency.  Ixgto  for  prooaaslng  mssauiameiita  la  actared 
arary  m^  oycta  of  tka  uarigatloa  aquations.  Tbia  logic  oompvtas  raakhial  soma  for  maasuramaota  which  are  hanrilad 
to  tbU  msaoor,  or  raaldusla  (or  tka  maaauramanta  arkiob  are  baodlad  disorataly. 


TIm  fitter  r>  ~onoe  time  la  clwaya  behind  real  time.  The  maxtmunt  laf  (before  lofic  will  faUI  to  operate 
properlr)  U two  filu.  ,«)rloda.  Aaauaie  that  real  time,  t,  llee  la  the  rettoo  W ^ i ^ • The  quantltlea  oeeeeeary 

for  defUliif  the  treaaltiaa  rnttrlx,  • (t;  t|j),  are  calculated  at  the  frequency  of  aoeeptlnf  meaeuremeata, 

Ae  preriouaty  meottooed.  two  types  of  meaeureatent  preproceeslac  Imre  b«s  Implomeated; 

(1)  Realdaal  aums  where  the  sum  It  carried  c^^er  a filter  nyole  (from  l^  to  t^^^  tu  Flfure  7).  if  the 
meaaurlac  derlce  prortdea  nearly  contlaitoua  meaaumraanta,  aa  oaa  be  the  oace  for  tirapeed  and  bero- 
atetrlc  altitude,  then  the  preprooeaelaf  lofie  aoeuaittlates  residual  sums  and  partial  sums  tar  refereao' 
Inf  the  reetdoal  nma  to  the  fitter  time,  At  time  t|(,.|  - A,  the  preprooeealag  logic  loada  the 
realdaal  suma  and  partials  for  proceealng  by  the  Kalman  filter.  The  errcya  used  for  aocumulatloo  are 
cleared  for  uae  In  the  next  filter  cycle. 

(2)  DIeorete  meeauraoteata  which  occur  at  aome  time  In  the  time  interval  tj^  to  t|[^^  ae,  for  czample, 
a petition  fix  or  a ater  fix.  Iht  preprooaaalog  logic  forma  the  realdual  and  partial  (for  referencing 
the  realdual  to  time  t|,)  and  loada  the  data  for  prooeaalng  by  the  Kalman  filter. 

The  Kalmaa-fUter  logic  In  amagnd  ao  that  once  keyad  to  proeeaa  measuremante.  It  via  taka  care  of  ell  the 
ffieeauremente  and  then  reference  the  Incrementel  (error)  state  to  current  time.  In  thia  manner,  errore  in  the  eacl- 
metod  state  are  corrected  ae  eooo  as  possible.  After  the  filter  has  completed  all  the  meaauremente  In  the  time 
Interrml  t|^  to  ll>a  logic  performa  e time  update  to  eatabltah  a new  filter  referetice  time  at 

The  niter  equatlone  for  the  Incremental  atate,  dx,  and  the  square-root  covariance,  are; 


A)  Time  Uxlate 


Let 


where 


(2) 


dx(t)  = ♦«:  tj^)  di(i|^) 


W(t^)  W(t|^)  = P(t^) 


P(t|^)  ° the  nxn  covariance  matrix,  and 

T 

W(t  ) » the  nxa  square-rcot  covariance  omLrU  updated  in  the 
“ filter 
T 

Then,  W(tj^^^)  la  formed  by  the  two-step  computatlooal  order: 

<a)  Btep  1 


i 


L 


r 


u^lt,) 


T T 

(b)  Step  2 ^ reduced  to  upper  trlgangular  form  with 

the  HeuaehoUer  algorithm  [2], 


A) 


A) 


T T T 

In  Step  1 we  note  that  AA  ' V*  * ^*St*  ' 

This  shows  that  U(t^)  represents  the  aquare  root  of  nolne  contribution  to  (he  growth  of  the  covarleoce 
matrix  la  e time  i 


U(t-)  r 
upciate. 

Measure  me  Bt  Update 


where 


and 


dx  " dx  ♦ K(k)  (Ay(k)  - H(k)  dx  ) 

4y(k)  - the  realdual  or  residual  aum  for  the  meaaurement, 
H(k)  - the  partial  (referenced  to  time  t^)  for  the  Ay(k)  residual. 


(*> 


I 


I 

I 


I 

t 

i 

I 

I 


H2 


(3) 


Define 

C-  (W(kf)'^  H(k)^ 

r?-W(k)’C  (5) 

X = (C”^C  + R(k))  yR(k)/(C'^C+  R(k)) 


Then,  K(k)  of  Eq.  (4)  Is  given  by 

K(k)  = Tj/(C'^C  + R(k)) 

and  the  square-root  covariance  Is  updated  by 

W(k)’^‘'  = W(k)'^’"-C>)^/x 

Transition  Matrix 

Let  ft 

^ J F(T)dr 

The  Integral  in  Eq.  (8)  Is  approximated  by 
jjF(T)dT= 


where 


nA-t-t^ 

Only  the  non-zero  terms  in  F(tj)  are  stored  and  updated. 
When  the  transition  matrix  is  needed,  the  non-zero  terms  of 


B = S F(t  ) A *■  ( S F(t.)  A)  /2 
i=l  ‘ 1=1  I 


(6) 

(7) 

(8) 

(9) 

(10) 

(11) 


are  formed.  To  Implement  Eq.  (1)  the  logic  below  is  executed. 

dx(t)  = dx  (tj^)  + B dxftj^)  (12) 

The  matrix  B of  Eq.  (11)  Is  kept  as  a vector  of  the  non-zero  elements.  Arrays  containing  indices  (or 
addresses)  are  appropriately  set  up  to  execute  a matrix  multiply  as  in  Eq,  ?)  . '.;hout  r.ny  multiplica- 
tions by  zeroes. 


3.5  Design  Validation.  The  aided  INS  is  sufficiently  complex  that  a design  validation  by  .•n..,'ji8  of  digital  simula- 
tion Is  almost  mandatory.  In  the  simulation  all  the  known  factors  affecting  the  system  are  simulated  and  the  overall 
system  performance  is  evaluated.  A simulation  consists  of  the  digital  implemer.ation  of  the  elements  shown  on 
Figure  8.  The  flight-profile  generator  shown  in  Figure  8 produces  the  specific-force  vector  acting  on  the  simulated 
IMU  and  a vector  of  true  position  and  velocity,  and  other  items  necessary  in  the  measurement  simulation.  The  flight- 
profile  generator  must  be  capable  of  producing  time  histories  of  the  indicated  variables  for  "typical"  flight  plans  the 
real  aircraft  will  fly. 

The  I.MU  simulation  generates  the  simulated  accelerometer  measurements  and  the  simulated  platform  response 
to  torque  inputs.  This  simulation  Includes  the  relevant  IMU  error  sources- 

(V)  Accelerometer  scale  factor,  misalignments,  null  bias,  noise,  and  quantization. 

(2)  Gyro  scale  factor,  misalignments,  steady  and  random  drifts,  mass  unbalance  drifts,  anisoelastic 
drifts,  and  quantization. 

The  airborne-computer  simulation  simulates  the  relevant  factors  affecting  performance: 

(1)  Approximations  used  in  the  navigation  equations  (gravity  model,  earth-curvature  model,  and  so  forth). 

(2)  Airborne-computer  compentiatlon  for  the  IMU  (sec  Figure  fi). 

(3)  .Scalin,;,  word  size,  and  other  numerical  characteristics. 

(4)  Kaln.an-fllter  approximations  in  areas  such  as  the  transition  matrix,  measurement  partlals,  and  so 
forth. * 


1-13 


AIRBORNE-COMPUTER 


fj(t)  = specific-force  vector  acting  on  IMU 
f^(t)  = measured  specific-force  vector  (by  accelerometers) 
to^(t)=  vector  of  commanded-gy  -torque  rates 
2(t)  = vector  of  true  position  - velocity,  etc, 
y(t)  --  vector  of  simulated  measurements 
Figure  8.  Functional  Block  Diagram  on  an  Alded-Navlgatlon-System  Simulation 


The  measurement  simulation  produces  a time  history  of  the  simulated  measurements  which  are  consistent  with 
the  flight  path  and  contain  realistic  modeling  of  the  measurement  error  sources: 

(1)  Random  error  sources, 

(2)  Error  sources  caused  by  timing, 

(3)  Bias  error  sources, 

(4)  Dropouts. 

(5)  Bad  measurements  (outliers). 

The  digital  simulation  can  uncover  many  problems  In  the  initial  deslgpi  for  an  aided  INS.  Examples  of  problems 
found  by  simulation  include: 

(1)  A singularity  in  the  covariance  matrix  which  under  certain  conditions  caused  unsatlsfnr':;;^  P'rformance, 

(2)  A poor  selection  of  the  order  of  data  processing  in  the  initial  design  which  gave  unsatisfactory  perfor- 
mance In  certain  modes  of  operation. 

(.1)  Mistakes  which  were  made  In  the  mathematical  formulation  of  navigation  equations,  transition  matrix, 
and  measurement  partlals  In  the  initial  design. 

(4)  Nonlinear  effects  in  the  initial  design  which  caused  unsatisfactory  performance  with  large  Initial  errors, 
(.5)  Approximations  developed  in  the  initial  design  which  were  not  adequate  for  the  full  range  of  operations. 

(6)  The  compensation  for  unmodeled  error  sources  developed  in  the  Initial  design  which  was  not  adequate. 

During  the  validation  phases  these  types  of  problems  (if  discovered)  can  be  readily  corrected.  In  the  flight- 
iest phase  their  Isolation  and  correction  can  be  very  difficult  and  costly. 


3.7  Onboard  Computer  Program  Development  and  Checkout.  A considerable  amount  of  detailed  programming  and 
checkout  was  performed  in  the  last  three  systems  the  author  has  helped  to  design.  This  experience  has  demonstrated 
several  important  details  which  are: 

(1)  It  is  important  to  have  a good  (preferably  one-to-one)  correspondence  between  routines  in  the  airborne- 
computer  program  and  routines  in  the  digital  simulation.  If  the  digital  simulation  has  been  properly 
modularized,  this  correspondence  is  very  useful.  For  example,  check  outputs  for  sample  inputs  are 
easily  obtalnf-d ; also,  the  logical  flow  governed  by  flags  in  the  simulation  program  can  be  copied  in  the 
airborne-computer  programming. 

A 
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<2) 


(?) 


H) 


(5) 


A dftadod  koovledce  of  the  iov'.ructUiua  «aprvl«ii  Id  the  alltiotno  computer  ie  (it-(Jimlj)e.  r'or 
«ittiupl«,  suppuae  Ihit  the  ruuUlpilcailor)  ni  t«o  ,^::-blt  wortS*  give  a ro>i(vJed  ?S-blt  anawer.  Then, 
on*'  mutt  taka  c«t»j  In  foroilng  the  maj{nlt(«ie  of  an  Inotir  product  of  tT(0  vecloio  In  order  to  retain 
Bifslficat'ce  lu  the  anawer. 

Knowledge  rd  the  Itnatrupt  ntmohji-o  tnd  how  the  filur  will  ba  time  a'la'^t  with  the  other  (highi  r 
priorll]')  logic  la  dedrable.  One  must  act  up  the  uohoaid  scftwnre  tnioh  Cliat  all  oalcu’atiuria  are 
couip'elod  tu  the  aUct.'.Kl  tinio.  Stct>«  abouki  bo  lniu<rt«d  to  protde  Indication  tl  the  time  order  of 
ca!culat|o>i>f  la  not  proper.  Alao,  the  timing  of  when  the  meuaurumrQts  arc  made  and  when  they  are 
prcce>ir,ad  can  be  Impoitant  In  'obtaining  the  re<}ulred  accuracy, 

Achniocod  planolog  and  eAra  acAware  U deelratle  In  the  checkodt  of  tho  onboard -computer  program. 

A alinuiuted  platform  and  profllo  guueratoi , and  elmulatsd  oieaaurementa  in  onboard  aoftware  la  imry 
helpful  In  cbocklog  out  the  narlgatlon  eqitcuooa  and  Kalman  filter. 

Prrper  a-.aliiiA  of  varlabloa  ia  very  Important  In  Slxed-poiU  currputera.  If  tta;  filter  dealgnrr  prcurami 
the  logic,  the  demUa  of  scaling  In  overy  operation  are  vary  evidsnl,  eo  one  can  ensure  proper  algnlf;- 
ranee  on  ail  the  opentlooa.  (f  the  i.u'OKrammlQg  la  to  be  given  to  a programmer,  then  very  detailed 
flow  cLartc  and  scaling  n’uut  be  provided  to  ensure  proper  elgniftcanoo. 


(6;  Digital  output  of  many  varlableit  on  a pi  Inter  ie  almost  a rsqulrement  In  KalmSB-filter  :heckoui. 

fioch  output  duel  come  In  an  oo-lloe  manner  without  affecting  uyetsm  o^isrvilnc.  Thla  type  of  data 
may  rujulre  apvnlal  aofltvare  In  the  nirhome  coti'.puter  mb  welt  a*  apeciat  hardvrare. 


3.  a Syavm  VaPdatlon.  Ooc  of  tiie  more  loteixiatlng  and  rballenging  phases  of  the  aided  INR  cleveloptr.ant  is  Iti6 
final  valtdadoD.  The  system  hardware  aud  software  must  play  together  to  give  the  desUsd  overa’I  reertooss.  Isola- 
t'.tn  of  Ilje  caaecs  of  undeslred  clutiaoterlailcu  can  be  very  dlfiicall.  In  the  auiticr'a  ftapcrlrnse  the  first  testa  are  In 
the  laboratory  where  the  ground  sUannent  and  frue  InorUal  modes  ere  caarcls^rfl,  aud  subtle  probloir.e  In  l>.Wh  hr. id- 
ware  and  software  are  discovered  s'kI  cotroctod.  Tlte  Kalman  filter,  which  Is  ustd  in  flight,  alsi.  pen'orni*  the  ground 
aligmneat  In  the  designs  toe  author  hac  loij>lemeDtad.  As  a result,  a g<:>od  ssrIoA  A Isborntory  testa  can  taildato  all 
the  fUKht  software  except  that  assoclaU'd  with  the  actual  navnid  moasurements. 


The  Importance  of  recording  approprUUs  data  tor  system  vslldallot'  In  the  Uhnrato'-y  and  in  >V‘ 
rasnot  be  overly  etresaod,  Thu  aioet  deMlral-le  lovOidiugs  siu  »nuh  that  post-flight  operations  permit. 


(1)  The  use  of  flller-sniootbing  techr.lquee  to  estimate  the  Mme  -varying  aystem  errors.  This  car.  be 
accomplished  lu  a goners  I -purpoee  computer  program  using  the  recorded  flight  data  If  proper  data 
la  taken. 

(2)  PlaytMck  of  the  recorded  flight  data  Into  the  airborne  computer.  An  option  In  the  l.'O  of  the  airborne 
computer  can  be  designed  so  that  recordad  flight  data  Is  used  In  placo  of  the  actual  ineaaurementa. 

Item  (1),  If  available,  permits  oae  to  get  at  better  models  of  system  errors  for: 

(1)  Correcting  hardware  deficiencies. 

(2)  Correcting  filter  approximations  lor  the  roal  error  sources. 

(3)  Correcting  the  errors  by  Imprtivlag  the  software  calibration  model. 

Item  (2),  if  available,  permits  one  to  use  the  recorded  raw  data  with  the  modified  soft-ware  to  validate  improvemente 
before  later  flight  tests. 

As  an  lllustrallon  of  the  type  of  problems  one  can  encounter  In  the  system- validation  phaeec,  an  experience  In 
the  RAINPAL  system  development  Is  deecrlhed  [3,  4,  . A block  diagram  of  the  expci  InicnUl  jystom  Is  shown  In 

Figure  9.  The  I.ltl  )o  LTN-51  INS  was  used  for  three-axis  accetei omuter  data  for  ihld  system  and  the  Ames/Cublc 
Precision  Ranging  iystem  (HIS)  was  tho  primary  navald. 


The  radar  altimeter  and  tho  barometric  alt'  — , -c'  were  also  used  as  navigation  aids.  Tho  navigation  equatlona 
and  Kalman  filter  were  executed  in  un  SP'  computer.  During  the  design  phase  of  this  system,  all  the  available  in- 
formation on  the  PRS  Indicated  thst  It  wau  a very  acc-urate  ranging  syetem.  Measurement  errors  were  bollevcd  to  be 
lets  than  abo-Jt  5 feet.  Simulation  studies  Indicated  that  a very  Mgb-accuracy  navigation  reference  was  obtainable 
(Sufficient  for  aircraft  Landing)  If  the  three  transponders  of  the  P'.-tS  were  properly  Imiated  with  respect  to  the  runway. 
The  PHP  measurementa  were  the  ranges  to  each  of  these  transpoalors.  These  range  meacurements  were  available 
at  a very  high  frequency,  but  they  were  only  ueed  with  a 0.5  Hr.  filter. 


T he  syBlcm  was  flight  tested  at  the  NXlilte  Sands  MIbbIIc  Range  (WSMR)  where  cine  theodolite  tracking  could 
give  an  excellent  reference  trajectory  for  accuracy  checks.  Figure  10  shows  the  flight  pattern  for  one  of  the  flight 
teats  nt  WSMR,  and  Figure  1!  shows  the  range-time  hlsloiles  for  this  flight.  Note  that  there  la  & slgr.iflcMril  mnuuoi 
of  bad  data  In  these  measurements:  however,  software  was  designed  to  reject  these  points  and  tho  bad  data  was  not  a 
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Fl^re  9.  Block  Diagram  of  Experimental  Navigation  System, 
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Figure  10.  Flight  Pattern  for  WSMR  Flight  teste  of  26  January  1972 
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Figure  11.  Range-Time  Hlatorlea  for  First  Landing  at  WSMR  on  26  January  1972 

serious  problem  In  the  tests.  All  the  raw  data  was  recorded  In  the  tests  so  that  experiments  could  be  run  after  the 
fact  (post-night)  In  the  SD6-920  software  to  access  accuracy  and  study  anomalous  behavior. 

Poet-night  processing  revealed  that  we  could  not  achieve  the  desired  accuracy.  After  considerable  effort  the 
problem  was  traced  to  the  PRS  system  whose  errors  were  considerably  larger  than  previous  tests  had  indicated. 
Residuals  (differences  between  the  PRS  ranges  and  ranges  computed  from  the  WSMR  cine  theodolite  tracking  data) 
along  with  the  computed  range-rate  histories  are  shown  in  Figure  12.  There  Is  an  obvious  strong  correlation  between 
the  range  error  and  the  range  rate.  The  error  source  was  traced  to  a design  deficiency  In  the  automatic  gain  and  fre- 
quency control  of  the  PRS.  Although  the  desig.'i  should  have  been  improved  and  the  tests  conducted  again,  this  was  not 
done  for  this  experimental  system.  Instead,  a software  compensation  was  installed  to  effectively  remove  the  error 
from  the  raw  data. 

Figure  13  presents  time  histories  of  the  WSMR  estimate  computed  from  the  cine  theodolite  data  and  three 
Kalman-fllter  estimates  computed  by  the  onboard  software  using  the  software-corrected  PRS  data.  The  onboard  soft- 
ware uses  every  20^^  sample  of  the  recorded  navald  data,  so  each  Kalman-fllter  estimate  shown  has  a different 
starting  time  and  different  samples  of  the  recorded  navald  data.  This  data  shows  an  excellent  comparison  between 
all  of  the  estimates,  which  Indicates  the  potential  performance  of  such  an  aided  INS;  however,  the  real  system  was 
never  reflown  to  give  an  absolute  validation  of  this  potential. 


Future  Trends  In  Aided  INS  for  Aircraft 


The  appllcatlonB-t3T)e  problems  and  their  nolutlons  which  have  been  experienced  by  the  author  over  ihe  past 
decade  have  followed  the  philosophy  of  designing  the  navigation  system  for  some  phase  of  aircraft  operatl  Two  of 
the  system  which  were  discussed  could  be  classified  as  "onroute"  systems  and  two  could  be  classified  as  .ermlnal 
area  and  landing"  systems.  The  emphasis  has  not  been  directed  at  a single  navigation  system  for  all  phases  of  flight 
from  takeoff  to  landing.  Future  systems  should  have  this  Integrated  design  approach,  since  It  gives  a means  of 
checking  each  now  class  of  measurement  (as  the  Tight  proceeds)  against  all  previous  measurements.  This  should 
improve  the  safety  of  operations  (bad  measurements  can  be  re)ect''d  and  warnings  of  failed  devices  provided). 

A related  area  which  has  been  barely  considered  In  these  designs  is  overall  reliability  of  the  navigation  system. 
The  designs  have  generally  been  of  a "single  thread"  typo.  In  that  many  hardware  failures  would  require  the  pilot  to 
switch  to  a less  accurate  system  for  a navigation  reference.  If  the  aided  navigation  system  Is  to  provide  the  capability 
for  all-weather  o^.-ratlons  Including  landing,  then  there  Is  an  obvious  need  for  very  high  reliability  In  all  of  the  sys- 
tems destlncf!  for  aircraft  use. 
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A promUlng  technique  fur  gaining  tilgb  reUabllUy  la  the  Inertial  sensing  devices  used  for  navigation  and  con- 
trol has  been  Implectented  by  The  Clisrles  Stark  Drap>r  Liwcratory,  Inc.  [s,  9,  lo].  The  techniques  uses  redundant 
skewed  aocolorotretei  s and  eyros  In  a atrapped-donivn  coofli^f-iratloD  (no  stable  platform  Is  iisqulrod).  Logic  In  the  alr- 
bume  computers  (dual  computers  are  used  In  the  Implementation)  checks  the  raw  sensor  data  and  removes  failed 
sensors  from  affecting  the  syetutn.  The  IMU  consists  of  st*  accjlercmeters  and  six  gyros.  Since  only  three  of  each 
type  are  required  for  thres'-axis  Information,  there  are  three  spares  of  each  type  (redundant  sensors).  The  soft^varo 
In  tho  computers  is  derlgned  to  detect  and  •bolat.  failures  of  up  to  two  sensors  of  each  type.  In  aildltloo,  the  sofCw'are 
can  detect  a .bird  failure  In  either  sensor  type,  but  cannot  Isolate  which  inatrumant  has  failad.  Such  a mechan'.iatloa 
provides  fall-operattooal  fail-safe  performance  for  one,  two,  or  three  failures,  respectively,  of  either  sensor  type. 

In  order  to  obtalr  i reliable  nr.vtgiitlor  system  fok  all  phasea  of  (light  it  is  necessary  to  use  reduriont  naviga- 
tion aids  as  well  as  re<.  cot  Inertial  sensors.  let  us  exsmloe  the  merits  of  the  aided  INS  depict  td  in  Figi're  14. 

In  this  system  we  havo  redundact  skewed  sensors  feeding  the  failure  detection  and  Isolation  (FDD  software  In  ^he  co-m- 
putor.  The  FLil  software  removes  effects  of  failed  sensors  so  th..  ltq>uis  to  the  navigation  equations  are  reliable 
signals.  Barring  computer  failures,  tbe  estimated  state  computed  by  ibe  navigation  equations  Is  therefore  reliable. 
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Figure  14.  Block  Diagram  of  a Redundant  Avionics  NavIgnUoo  System 


That  is,  fal’urte  ir.  serwore  up  to  some  maximum  number  are  tolerable  and  do  not  L.ve  a large  elieot  on  the  elate 
eatlmale.  lire  accuracy  of  tho  state  estimate  will  depend  on  the  past  history  of  operation  (from  alignment).  Tbe  co- 
variance  matrix  calculated  by  the  KaUtian  filter  cv'i  bo  a rellatde  Indication  of  this  accuracy,  provided  we  are  able  to 
detect  and  Isolate  (remove)  bad  navald  meaeurements. 

The  covariance  rnatrlx  and  tho  estimated  slate  are  u*>ed  In  the  failure  delecUou  and  isolation  logic  of  the 
meaeurements  from  the  redundant  navigation  aide.  Residuals  calculated  In  this  logic  can  be  accepted  or  rejected 
based  on  comparison  of  the  magnitude  of  the  reolduai  to  calculated  Btatlstlcal  boundaries  which  are  consistent  wilt'  the 
accuracy  of  the  nieaeurement  device  and  the  accuracy  of  the  estimated  state.  If  surh  logic  Is  used  on  two  reduiidan' 
receiver  outputs,  then  fall-operational  fall-safe  operation  Is  possible.  If  one  receiver  (alls,  tbe  logic  will  automatl 
cally  reject  the  measurement.  If  both  fall,  (hen  both  will  be  rejected  and  the  necessary  warning  for  pilot  action  wilt 
be  provided.  This  warning  need  not  take  place  Instantaneously,  since  the  overall  accuracy  will  degrade  slowly  rather 
than  ab*TiptIy.  Hence,  If  the  failure  Is  of  an  Imermlttenl  type  the  syefem  esc  contlcje  In  meny  cltuxtlo.-.B.  Ev.iii  with 
a 100  percent  failure  In  tbe  nsvulds,  tbe  flight  may  be  able  to  proceed  (as,  for  example,  In  crltlca'  landing  problems) 
without  cstastrophic  results. 

This  type  cf  system  has  (he  desired  Inherent  rollablll'y  for  advanced  automatic  larvling  aircraft.  By  having  a 
single  Integrated  system  for  all  phases  o(  flight,  the  desired  automatic  testing  and  failure-removal  operatlops  are 
applicable  to  all  of  tho  navalds. 

One  cbvious  dlsud'.'Botogo  In  the  approach  Ilea  In  achieving  reliability  In  the  computer.  Dual  computer  strategy 
has  beeii  Implemented  In  tbe  SIRU  system  of  References  [sj.  [oj,  and  [lo].  Since  there  lo  also  a <yjod  deal  of  applied 
research  directed  towards  developing  reliable  computers,  this  proo.t>m  should  be  resolved  lo  the  near  future. 

U Ic  believed  that  this  type  of  Intogratod  nvlootc  systom  will  eventually  supersede  the  "add-on  black  box"  approach 
(d  currer.)  avionic  systems.  A lot  of  applied  research  and  devolc^ment  and  exp-irlmental  testing  Is  required  before  such 
sophisticated  designs  are  practical  and  cost  effective  for  use  In  commercial  aviation. 
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This  paper  has  presented  practical  conEldemttons,  prohloni  areas  and  solutions  experienced  by  the  author  in 
the  development  of  halman  filters  for  aircraft  uavigatloti  systems.  The  problem  areae  experienced  have  been  In  throe 
categories  as  follows: 

(1)  Numerical  probleme  In  carrying  out  the  Kalman  filter  covariance  calculntlons. 

(2)  V’rohlemc  In  satisfying  t'le  constraints  Imposed  by  the  specific  airborne  computer’s  capoblltlles  used 
In  the  design. 

(3)  Probleme  in  developing  an  appropriate  mathematical  mode!  of  the  overall  system  which  1b  sufficiently 
accurate  atad  simple  eiiocgh  for  Implementation. 

The  equaro-toot  Implementation  of  t ie  Kalman  filter  described  in  the  paper  has  eliminated  problem  area  (1) 

Id  the  designs  cxperleiu  ed  by  tlic  author,  .advances  aiade  lo  airborne  computational  capabilities  have  reduced  the 
difficulties  of  problem  (2)  to  tbs  po'ct  where  it  no  longer  puses  a serloua  design  conetralnt.  Problem  area  (3) 

Is  and  will  likely  continue  to  lie  u.c  m..ait  difficult  problem  In  applying  Kalman-ftllcr  theory  to  practical  deeigns. 
Problem  area  (3)  will  porslat  because  we  continue  to  look  for  Improvements  In  systeni  performance  without  necessarily 
Improving  the  system  hardware.  Improved  performance  rcsulto  from  Impioved  modeling  and  compensation  for  error 
sources  and  consequently  requires  ever-increastng  complexity  In  the  systerri  software. 

The  designs  dlscusacd  Ir.  the  pafier  were  of  a single  thread  nature  with  respect  to  reliability  consldaraltons. 
Future  avionic  aystet.t.x  are  likely  to  require  fall-operational  fall-safe  performance,  which  Is  c4)talned  through 
redundant  components  and  redundancy  management  software.  The  conceptual  design  (as  described  in  the  paper)  for 
such  a syntem  makes  use  of  Kalman  filter  quantities  In  the  redundancy  management  strategy.  This  appears  to  offer 
a promising  method  for  gaining  the  reliability  Imi'rovements  needed  In  nvlonlc  systems,  olthough  practical  designs 
which  use  such  etrategy  have  yet  to  be  demonstiatcd. 
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SUMMARY 

Techniques  that  have  been  used  to  Implement  tlie  IGilmao  filter  for  aircraft  Inertial  navigation  applications 
are  presented.  The  applications  Include  AMSA  advanced  development  task  flight  test,  FB-111  and  F-lllD  aircraft 
avionics,  at-sea  alignment  aboard  aircraft  carriers,  and  stationary  alignment  of  electroatatlc  gyro-strapdown 
navlgatioii  system.  Techniques  used  to  simplify  the  filter  model  are  dlscuseed.  The  use  of  random  walk  and  white 
noise  error  sources  is  described.  State  vector  transformatlone  are  performed  to  simplify  the  filter  model. 
Detection  of  failures  Is  accompUehed  by  testing  the  measurements  for  reasonableness.  Computational  technlc^es 
used  In  computers  with  fUed-polnt  arithmetic  are  dlscuaned.  A flexible  covariance  matrix  scaling  technique  is 
essential  to  mnintsir  adequate  resolution  In  a fixed-point  computer.  ESlcient  algoiiUuna  for  covariance  matrix  and 
state  vector  exrrapolatloD  and  reset  are  described. 


1.  INTRODUCTION 


This  lecture  dlecusees  some  of  the  practical  considerations  that  have  been  found  to  be  useful  In  Implementing 
Kalman  filters.  Specifically  discussed  Is  the  appllcatlor  to  aircraft  itierilal  navigation;  however,  the  techniques 
should  prove  useful  In  mauj'  other  applications. 

This  lecture  is  based  on  experience  In  Kalman  filter  applications  to  aircraft  navlgatloo  that  dates  from  1964. 
The  Kalman  filter  has  been  Implemented  In  real-time  digital  computers  for  flight  test  of  Doppler-lnortlal-checkpolnt 
navigation  and  transfer  alignment  on  the  AKSA  advanced  development  task  (19C6-196S),  FB-111  and  F-lllD  aircraft 
navigation  systems  (1968-1970),  at-sea  allgiunent  aboard  alrcr^  carriers  (1968-1974),  and  stationary  alignment  of 
electrostatic  gyro-strapdowo  navigation  syetems  (1973-1974). 

The  AMSA  mechanlzutlon  was  the  first  real-time  Implementation  of  the  Kulman  filter  to  aircraft  navigation  at 
Autonetlcs,  although  a relatively  simple  lllter  was  used  for  submarine  navigation  at  an  earlier  date.  The  AMSA 
mechanization  is  programmed  In  a 24-bit  MARUAN  computer  with  a disk  memory  having  a lu  nriUisecond  acccsc 
time.  The  nopriter-lnertlal-checkpotnt  mechanization  has  a 14-element  atate  vector  and  a filter  cycle  time  of 
24  Seconds.  TTis  Uansfer  allgunient  mechariizatios  has  an  ll-elenient  state  vector.  Tlic  MARDAN  computer  has  a 
digital  differential  analyzer  (DDA)  section  that  does  the  navigation  function,  which  leaves  the  general-purpose 
section  free  to  du  the  filter  oomputatioos. 

The  FB-111  meebanizatioo  is  programmed  In  a 16-bit  IBM  4-  computer,  The  mcchaoizatloa  has  a 13-element 
state  vector  and  a filter  cycle  time  of  8 seconds.  Ma.'clmum  execution  time  for  one  (liter  cycle  la  180  inlllisoconds. 

It  requires  2200  16-btt  words.  The  f-lllD  mechanization  is  similar,  but  somewhat  simpler  because  It  bao  fewer 
sensors.  The  FB-111  filter  cycle  operates  In  either  the  Inertial  navigation  mode  or  the  dead- reckoning  mode.  The 
dead-reckoning  mode  tvavigates  with  a n>agneUc  compass,  and  either  Doppler  radar  or  true  airspeed  velocity 
seodors.  The  measurements  that  can  be  processed  by  the  filter  are  position  (visual  or  radar),  Doppler,  true  air- 
speed, astrocompaoB  azimuth  and  elevation,  velocity  fix,  liand-cntered  wind,  and  hand-entered  magnetic  variation. 
The  velocity  fix  consists  of  two  successive  position  fixes  on  an  unknown  landmark.  The  hand-entered  wind  and 
magnetic  variation  measurements  are  techniques  U>  allow  the  pilot  to  Initialize  Uiose  elements  of  the  stale  vector 
while  In  night,  A priori  uncertainty  In  the  pilot's  Information  Is  used  as  the  measurement  noise  to  provide  an 
optimal  estimation  of  wind  or  magnetic  variation  when  the  error  terms  are  included  in  thie  state  vector. 

The  mechaaization  Is  divided  Into  eetlinatiun  and  control  sections.  The  estimation  section  Implements  a 
Kalman  filter  aigorlthir.  for  discrete  measurements.  The  measurements  ere.  In  general,  a nocilnear  function  of 
attitude  (sine  and  cosine  of  heading).  However,  the  estimated  state  vector,  x,  Is  extrapolated  with  the  linearized 
state  equation 

i(t)  - F(i)ii(t)  (1) 

since  It  only  contains  small  error  terms.  T.ie  estimated  state  vector  Is  carried  primarily  to  correct  timing  errors 
in  cxiiitrol  appllcadous.  The  estimated  state  vector  x(t;^)  Is  applied  ae  the  control  to  correct  plant  errors  at  time 
tg.  !•  This  Is  because  the  digital  computation  must  lag  real  time.  The  sequence  of  events  Is  shown  in  Figure  1. 

The  computatlocs  associated  v/lth  the  control  vector  are 

^<‘k.i>  “ «<*K.rS<’"'“k>  - \<‘k.i> 

where  x^  Is  the  contiol  vector  and  * la  the  transition  matrix. 
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Figure  1.  Time  Sequcnoe  of  Eatlm>tl<n  uad  Control  CompuUtiooe 


Control  is  sfiplled  tinpnislvely  to  all  plaot  artatss.  All  merOal  navlgatlQO  states  are  directly  aocessatde  except 
platform  tilt,  slnM  only  * finite  gyic  torqulng  rate  cm  be  applied.  A nonlinear  platform  controller  Is  built  Into  the 
navlgatlan  mechanisation  that  mathematically  transforma  the  accelerometer  data  through  the  oattmsted  but 
unoorrected  platform  tilt  The  irr’ema  trao^ormatioD  la  used  to  rotate  the  sngilar  rate  vector  of  the  navigation 
frame  back  to  the  tilted  platform  coordinates  for  use  In  gyro  torqulng.  This  allows  effective  impulsive  tUt  cootrol 
and  atlU  usee  small  gyro  torqulng  rates. 

The  following  discussion  Is  applicable  to  all  of  these  applications.  Successive  applioaUons  represent  refine- 
ments of  the  basic  ideas.  Motrt  of  the  examples  are  taken  from  FB-111. 

The  technlquea  dlscuased  generally  faU  into  two  categurtea,  modeling  considerations  and  computatloaal 
techniques.  The  Importance  of  developing  an  adequate  model  for  the  suboptlmal  Kalman  filter  Is  well  known. 

Several  tcAbnlqoes  for  further  simplifying  the  mathematical  model  are  dlscuased  In  Section  2.  Algorithms  have  lieen 
developed  to  allow  efflclant  computation  of  die  Kalman  filter  equations.  The  algorithms  are  Implemented  In 
computers  with  fixed-point  arithmetic  and  are  discussed  In  Section  3. 


2.  MODELING  CONSIDERATIONS 

The  matnematlcal  filter  model  of  the  plant  used  Lc.  the  Kalman  filter  Is  deOned  by  t^e  state  equatltsi 
x(t)  = F(t)x<t)  * G(t)u(t)  (4) 

and  the  measurement  equaUon 

y(t^)  - H(t^)  x(i^)  + v(t^)  (6) 

where 

X - state  vector 
F • coefficient  matrix 
0 • process  noise  distribution  matrix 
u ' white  procees  nolee  vector 


y « measurement  voctor 
H = measurement  matrix 
V Gauaslan  sequence  of  measurement  oolee 

The  filter  model  Is  suboptlmal  In  that  K doea  not  exacUy  deecrlbe  the  plant.  However,  it  must  eff>  '<17  ily 
denciihe  the  major  error  mechanisms.  The  filter  model  is  evaluated  bv  means  of  computer  error  analysis.  A 
covariance  Bnalysls  program  is  used  which  runs  '>n  an  IBM  3'0  computer.  The  program  osea  the  luieT  ri.e5fleisnts 
fronn  the  suboptlmal  filter  to  compute  the  covariance  of  navlgatloD  errors  (position,  velocity,  and  attltrJe)  due  to 
one  or  a group  of  error  sources.  Time  hJsloiy  of  total  system  performance  Is  jctalned  by  summing  the  covariances 
computed  from  the  lodlvidual  error  sources.  The  Kalman  fUter  model  Is  chosen  by  analjrzlng  srrenl  models  with 
d e progimm  and  choosing  the  one  that  gives  the  best  performance  without  unduly  complicating  the  mechanlratlon. 

The  choice  of  a filter  model  la  an  baurlotlc  Judgmmtt  and  do  attempt  baa  been  made  to  quantize  1'.  The  filter  evalua- 
tion must  be  made  on  aeveral  flight  profiles  acd  mulhceoaoi  mixes  baaed  on  expected  missiooa.  Several  design 
concepta  have  evolved  baaed  on  a large  number  of  analyses  which  were  performed  over  the  last  decade.  Some  of  the 
major  coocopta  are  described  In  the  following  eocUona. 

2.  1 ERKOa  iiODHCE  DESCRIPTION 

Tlie  error  budget  for  gyro  drift  rale  ermr  usually  consista  of  blaa  error,  long-correlation-time  exponentially 
ccrrelated  error,  and  ahort-correlatlon-Ume  exponentially  correlated  noiae. 
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The  shoit-oorrelatlon-ttme  rmndom  gyro  drift  rate  l«  approxli&eted  by  white  noise.  The  white  noise  power 
spectral  density  amplitude  Is  chosen  equal  to  the  zero  frequency  I%D  ampUtude  of  the  correlated  error 
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where  white  noise  PSD  amplitude  and  a ^ and  i , 
error,  respectively.  The  approximation  la  valid  If 


T < = 800  seconds 
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are  variance  and  correlation  time  of  the  short-correlatlon-tlme 


(11) 


where  -g  is  Schuler  frequency,  since  the  transfer  function  from  gyro  drift  rate  eiTcr  to  velocity  error  has  a pass 
band  between  zero  frequency  and  Schuler  frequency.  The  effects  of  error  signals  rlgnlflcantly  abovo  Schuler 
frequency  are  highly  attenuated. 


The  bias  and  kmg-correlatlon-tlme  error  sources  are  approximated  In  the  suboptimal  filter  by  a random  walk 
model.  The  equivalence  between  the  statistics  of  an  exponentUiily  correlated  random  process  ptmI  a random  walk 
process  Is  strictly  empirical.  The  suboptlmai  fitter  using  a ran^m  walk  model  tends  to  result  in  slightly  pessimis- 
tic filter  error  ststletlcs.  pessimism  Is  desirable  in  a Bub^pUmn!  filter  to  account  for  unmodeled  error*. 

The  differential  equation  for  the  random  walk  model,  < is 
*r  " \ 

where  Is  white  noise  with  PSD  amplitude  Qr-  Tlie  variance  of  an  uncontrolled  random  walk  model  grows  linearly 
witit  time.  The  Intent  is  to  describe  an  error  source  that  changes  value  In  some  fixed  time,  T,  In  a manner  similar 
to  the  long-ooirelatloo-time  error,  < or 


A*  2(T)  = E j . j (0)  - • j^(T)  (13) 

= (1-e'^'’  L) 

2 2 

where  A«  Is  the  variance  of  the  rhange  zjkI  ^ ''  L variance  and  correlation  lime  of  the  long- 

correlatton-ttme  error,  * i_.  It  has  been  erojiliic^tily  found  through  error  an^y  »ls  that  the  best  /liter  performance 
is  obtained  when  the  change  Id  variance  of  tho  rai.dom  walk  model  Is  near  v j m time  ^ ^ or  in  other  words  the 
PSD  amplitude  of  u^  Is 


The  random  walk  model  has  several  practical  advantages  that  make  it  attractive.  A slng'e  state  variable  can 
be  used  to  model  the  sum  of  bias  plus  several  exponentially  correlated  errors.  Ibe  control  law  Is  a bias.  If  models 
for  bias  and  exponentially  correlated  processes  are  used  Instead  of  the  random  walk  model,  separate  state 
variables  must  be  usitd  for  each  model.  Separate  control  laws  must  also  be  vsod  for  bias  and  evponenUally  corre- 
lated models,  sUtce  the  contiol  applied  from  the  exponentially  correlated  mcxlel  must  be  decayed  to  zero. 

Doppler  radar  presents  s similar  modeling  problem.  The  error  budget  for  over-land  operations  usually 
contains  high-frequency  fluctuation  noise  and  scale  factor  and  bureslghl  errors.  The  scale  factor  and  boroslght 
errors  are  described  as  bias  and  long-correlaUon-tlme  exponentially  corrcLited  errors,  'fhe  fluctuation  noise  Is 
modeled  as  white  noise  at  the  velocity  level.  It  has  a PSD  amplitude  proportional  to  alrcra'l  velocity,  'fhe  bias 
and  long -con  elation-time  errors  are  modeled  as  random  walk  In  scale  factor  and  bore&lg''  as  described  above. 


2-4 


'W' 


Doppler  zeder  performenoe  operetlBg  over  mter  la  corrupted  by  the  veloolfy  of  the  water  anrfaoe,  called 
aea-drUt  Sea-drift  la  modeled  aa  random  walk  In  two  horicontid  oomponenta.  Thla  error  replacea  the  Doppler 
aoale  fhotor  and  boreal^t  random  walk  atatea  in  the  atate  vector  during  oveivwater  opeiatloii.  State  variable 
replacement  la  commonly  uaed  to  maintain  a email  atate  vector.  Thla  reaulta  In  a auboptlmal  ttlter  alnoe  aoale 
Doctor  and  borealght  errora  are  atlU  preaent  over  water.  However,  the  aea-drlft  effect  la  tike  largeat,  ao  acceptable 
filter  performance  la  obtained  without  the  aoale  factor  ud  borealgh^  modela  <vhlle  over  water. 

If  Doppler  radar  la  not  available,  true  alrapeed  reference  velocity  la  uaed  and  two  componenta  of  wind  veloolQr 
uncertainty  are  modeled  aa  random  walk  In  toe  two  reference  velocity  atate  varlablea. 

Hl{^fre<;pienoy  accelerometer  errora  are  modeled  aa  white  nolae.  Accelerometer  blaa  errora  are  generally 
unobaervable  unleaa  a platform-mounted  atar  tracker  la  uaed  and  ao  are  not  modeled.  I/mg-correlatlon-tlme 
aooelerometer  errora  ahould  be  modeled  If  they  are  algnlfloant.  However,  the  white  nolae  gyro  drift  rate  model  la 
i^roxlmately  e<]ulvalent  to  random  walk  accelerometer  errora  aince  the  difference  between  tilt  and  accelerometer 
errora  la  unobaervable.  It  ahould  be  recognized  that  gyro  drift  rate  and  tilt  are  both  obaervable  ao  the  approxima- 
tion ylelda  a auboptlmal  model.  Long-correlatlon-tlme  accelerometer  errora  are  not  explicitly  modeled  In  toe 
applloattona  dlBOuaaed. 


Gravitational  anomaly  deflection  of  toe  vertical  la  modeled  aa  white  acceleration  nolae.  The  effective 
correlation  time  of  toe  white  nolae,  Tg,  la 

T = 50nml/V 

e 


(15) 


where  V la  aircraft  apeed  and  toe  correlation  dlatance  of  the  gravitational  anomaly  la  aaaumed  to  be  50  nml. 
The  atate  vector  choaen  for  FB-111  navl^dion  ayatem  haa  13  elementa  which  are 
X,  y poaltlon  error 
X,  y velocity  error 
X,  y,  z -angle 


X,  y,  z drift  rate  error 
2 reference  velocity  errora 


aatrocompaaa  borealght  error. 

where  x,  y,  z define  a locsdly-level,  azimuth  wander  coordinate  frame  wlto  z axis  up. 

The  aame  state  vector  la  uaed  for  dead- reckoning  mode  with  the  4'  -angle  atatea  identical  to  toe  poaltlon 
error  states  and  the  drift  rate  error  states  not  used. 


Notice  that  vertical  channel  la  not  Included  In  the  state  vector.  The  vertical  channel  only  weakly  coiq>les  the 
two  horizontal  channels  through  Coriolis  terms.  If  vertical  velocity  error  is  kept  small  thiou^  conventional  baro- 
altltude  damping,  horizontal  velocity  error  is  not  significantly  affected. 

2.2  CHOICE  OF  COORDINATE  FRAME 


The  importance  of  choosing  toe  proper  state  variables  to  simplify  the  problem  is  well  known.  Two  examples 
are  given  In  Sections  2. 2. 1 and  2. 2. 2 of  state  variable  transformations  that  simplify  the  filter  calculations. 

2. 2. 1 Elimination  of  Acceleration  Terms 


The  inertial  navigation  system  linearized  error  equations  [1]  can  be  written  as 


AV 

c 

= AX+  - 

2 

(w  + n)  xAV  - uj  AR  - 2w  (Aw  )R  + V 
C C 8 a s 

(16) 

AR 

II 

o 

1 

pxAR 

(17) 

+ = ->JgX4'  + « (18) 


where 

AR  = geocentric  position  error  vector 

“ veloclfy  error  vector  In  computer  coordinates 
'i‘  » vector  angle  rotation  from  computer  to  platform  axes 
A = specific  force  acceleration  vector 
V “ vehicle  velocity  vector 
n - earth  rate  vector 

u “ spatial  rate  vector  of  locally  level  frame  with  respect  to  inertial  frame 

« 

- Schuler  frequency 


r • whlole  r«te  vector  of  locally-level  fraruc  with  respect  to  Earth  fixed  (ra;-oe 

V “ aoceierometer  ‘vrror  vector 

I gyro  drift  rate  erior  vector 
dw 

^ -e  ““afT 

R » geocentric  po»lti>>o  vector 

These  state  equaiioas  arc  tliiie  varying.  The  solution  to  the  eijuatlona  is  compl'c/ir<;d  by  tr.e  (na  thsi  liie  accelera- 
tion vector  can  vary  quite  rapidly.  It  le  possible  to  choose  a linear  combiriatlon  o!  Uieeu  state  ’.'nildllas  "jjat 
eltmlsate  acceleraUon  terms  fiom  the  state  equation.  The  traneforiuatlou  Is 

» V X V (19) 

Phystcalty  this  can  be  Interpreted  aa  tilting  Ihe  three  components  of  velocity  contained  In  the  computer  inemury  as 
being  along  the  platform  axea  instead  of  the  computer  axee  when  computing  velocity  error.  aV„  Is  called  the 
velocUy  error  vector  In  platform  coordinates. 

The  derivative  of  Eq  fl9)  is 

AVp  ” * y,\V  » vxlA  - ‘ i<)xV  < g|  (20) 

where  g la  gravity  vector.  'Jalng  Eq  (i$)  and  (2C)  to  eliminate  In  Eq  (16)  and  (17)  gives  the  state  equations 


■ 

p 

-("g  UlxAVp  - - gx-  - VxPxv  - «)  - 2_^(A„^)R  * r 

(21) 

aR  ■ 

AVp  - pxAR  ■»  Vxv 

(22) 

V " 

“exy  •*  < 
t 

(23) 

Figure  2 showe  the  state  etgiatlons  tXq  (21)  through  (23))  In  matrix  form  for  two  horizontal  charmels  with  an  azimuth 
wander  coordinate  frame  a^  neglecting  vertical  velocity.  These  equations  do  not  contain  acceleraUon  and  so  are 
uuvii  vaster  bu  accutateiy  integrate  numerically. 


Figure  2.  Inertial  Navigation  Error  Equations  in  the  Platform  Frame 


2. 2. 2 StaUookry  AUjjumeat 

The  itattonary  allgiunent  (Utor  la  a special  case  because  of  the  many  almpUfloationa  tt»t  oac  be  ms(<e.  O* 
OouTM,  atauuuaty  augument  can  be  perlormeu  *^u  tbe  genetal  oarlgatlon  filter  but  mao>  applioattons  only  require 
a ^tlooary  alignment  auch  as  F-lll  autonomoua  navigation  or  any  applicatloo  ttiat  haa  no  alrboms  navlgaUun  aide. 

After  Initial  tilt  errors  have  been  removed,  the  crest  coupling  between  the  two  borieontal  navl|^tlaa  channel* 
U vety  amall.  A three-atate  filter  la  uaed  which  oaotalna 

aV.  velool^  error 

a ■ 9,  tilt  error  (24) 

« , drift  rate  error 

l.  J 

One  aet  of  filter  coelflcieota  la  computed  foi  both  x and  y channels.  The  oorreapondence  la 


, X channel 


X •>  I 8^  . y channel 


Azimuth  la  Initialized  by  computliig  the  angle  from  north  to  the  x-axla  (positive  counter  clocicwlse),  o,  as 
•’  !-■-  * * \ 

a » *tafi  ( — i-J  (27) 

’ 'J 

which  defines  north  aa  the  direction  of  the  aenzed  borizmttal  angular  rate  vector.  EsUmated  north  gyro  drift  mte 
vector  ia 


n • earth  rate  vector  before  azimuth  control 
U*  - earA  rate  vector  after  azimuth  control. 

The  simplest  way  to  eUmluate  the  cross  coupling  duo  to  initial  tilts  Is  to  r-'atart  the  filter  after  the  first  few  seconds 
when  the  largo  tilts  bavo  been  removed. 

The  stattonary  alignment  mechanization  Is  not  Schuler  tuned.  The  g>'rr>s  are  only  torqued  at  earth  rate  plus 
estimated  gyro  precession  rates.  Coriolis  compensation  is  not  mechanized.  This  simplifies  the  mode);  ellmlnatce 
unnecessary  cross  coupling,  and  reduces  the  numerical  errors  in  computation  ol  the  average  velocity  measuremoot. 
The  state  equations  are 


where  u Is  a white  noise  vector.  The  average  volocliy  aeasurement  matrix  Is 
K » (1  - gT/2  gTV6) 


and  the  transition  matrix  la 


gT  gT‘/2 


(31) 


where  T is  the  filter  cycle  time.  An  addittonal  aimplificsUnn  oad  b«  rwaiiLod  bv  itneT  tnp-^formmioa  o(  the  suite 

vecU^r  (o  X'  AS 


2-7 


•gT/?.  ^ /6 


which  gives  an  average  velcclty  state  variable.  The  roeaeurement  and  transition  matrices  become 


H'  - [] 


[i  rt  o'! 

0 1 T 


The  initial  covariance  matrix,  P . Is  also  transformed  from 

o 


• (gT/2rqg  • (gTVeiqJ  (-(gT/2)q^J  ( (gTVc)q 


J'o  = l-(gri/2)qgl  q^  0 (36) 

. l(gl“''^)q,l  0 q^ 

The  Initial  covariance  matrl.%  io  precomputed  oo  the  addition  of  the  non-zero  ofl-diagonal  terms  la  not  a slgulflcant 
complication.  However,  the  zeros  Introduced  In  the  H'  and  4''  n.atrlces  do  Elgultlcanlly  reduce  the  amount  of 
computation  done  each  filter  cycle.  Filter  coefficients  are  computed  In  Uie  conventional  manner.  Scaling  la 
coieuiueu  with  Uie  fiitei  uoeffiuleiit  C.juiputotiOu  as  dveC rlbvd  in  S^tior.  2. 1. 

2.3  MfASUREMENTS 

Mcasuremcntfl  aro  obtained  from  sensors  that  supply  conti.nuous  data  such  as  Uoppler  radar  or  discrete  data 
such  as  a position  chockiKilnt.  Continuous  data  measurements  are  prefiltercd  by  moans  of  integration  to  obtain  a 
discrete  measurement.  For  example  the  Doppler  measurement  Is 


CV  ■'I 


- Vjj(i))d' 


where  Vj  and  Vp  are  inertial  and  Doppler  o-.need  horizontal  velocities,  respectively.  There  Is  no  significant 
information  loss  relative  to  a continuous  lialman  filter  as  long  as  the  IntegraUoD  time  Is  very  short  relative  to 
system  dynamics,  l.e.,  aircraft  maneuvers.  Error  analysis  studies  have  denionslrdted  tnat  filter  performance  is 
not  scmsllive  to  filter  cycle  time,  (t)^  - tk_i).  The  basic  Doppler  radar  Information  Is  posItloD  change  pulses.  The 
prefllter  mechanization  alleviates  the  reed  to  generate  Doppler  velocity.  The  measurement  matrix,  tj^  .), 

must  model  the  pr^flltcr  Integration. 

A dlBcrete  measurement,  such  as  position  checkpoint,  can  occur  at  any  time  during  the  filter  cycle.  The 
measurement,  yftj^).  Is  computed  av  Ihe  time  the  inoasuremont  ..ccure,  t^.  However,  It  Is  used  as  If  It  occurred 
St  the  errd  cf  t-he  filter  cycle,  tj. , ( !k-l  '•trThJ-  This  simplifying  spj'T^’dmstion  l«  made  hnenune  a constant  time 
interval  filter  cycle  requires  less  computaaon.  The  apptoximatlou  can  be  made  becaiiee  the  estimated  measurement, 
Hx,  Is  small  since  control  Is  applied  regularly.  Also  the  filter  coefficients  will  not  change  eignUicaiitly  with  a small 
change  In  the  position  checkpoint  time  of  occurrence. 

The  approximation  of  a constant  time  Interval  filter  cycle  cannot  always  be  made.  For  e.3mple.  If  the  velocity 
dllference  Integraj,  Er,  <37),  was  only  available  over  Irregular  Intervals,  the  filter  cycle  wc>iJd  navi  u.  be  variable  to 
fit  the  integration  time. 

2.4  FAIUJRE  DETECTION 

The  measurement-error  vr,rlanoes  computed  in  the  Kalman  filler  can  be  used  to  check  for  failure  or  degraded 
porfonnance.  The  technique  has  been  used  to  detect  Incorrect  position  ''heckpoint  dealgnozions  on  the  AMS.\  flight 
tests.  A failure  Is  said  to  occur  when  the  moasurement  magnitude  exceeds  Ita  3-  value  where  mc».3ur>xtiient 
magnitude  squared  Is 


(y  - Hx)^  (y  - Ilk) 


(38) 


and  Ita  vaiiuce  ta 


» Tr«o«  HPH  - R 


A failure!  oeo..i3  U 


and  Uia  checkpoint  la  rejected.  The  pilot  has  a i.  <■  aecooda  to  override  the  rejection  and  force  the  checkpoint  to  be 
accepted.  If  the  checkpoint  rejection  la  orerrldder,  th..  meaauremsit,  J,  la  applied  to  the  cunent  fllte’’  cycle 
without  further  compeneatloD  for  the  delayed  application.  Ihle  doea  place  an  additional  burden  on  the  pilot  to 
evaluate  rejected  ct^kpointa  and  make  a go/no-go  deolalon.  Tht.  .-cechanliatloD  was  only  used  for  fU^t  teat  and  not 
In  an  operational  system. 

A similar  mechanization  haa  been  proposed,  but  not  mechanized  to  detect  ban  data  or  failure  In  reference 
veloolty  Information.  Reference  velocity  measurementa  are  tested  at  each  filter  cycle  and  s pasa/fall  decision  Is 
made.  Continuous  failure  of  Doppler  Information  could  Indicate  over>water  operation  with  a La.r^  saa<Klrift  error. 

In  thii  case  the  filter  model  Is  itched  to  the  over-water  mode  which  models  sea-drif!  velocity  en\.'~. 

Failure  detoction  allows  the  computer  to  override  the  navigation  mode  selection  made  by  the  pilot.  Thle 
approach  admittedly  has  Its  pitfalls.  Good  data  can  be  rujected  due  to  a misaligned  system  relative  to  Its  covariance 
matrix.  For  this  reason,  there  Is  reluctance  to  place  falluie  detection  capability  into  an  operational  system. 

3.  MECHANIZATION  FOR  FDtED  iK>INT  ARITHMET’C 

The  basic  equations  associated  with  the  discrete  Kalman  filter  are 

P~(k)  - *r-,  k-1)  P>-1)  ♦’’’(k.  k-1)  4 Q(k.  k-1)  (41) 


X Ck)  * «(k,  k-1)  X (k-1) 

K(k)  - P(V)  H‘'‘(k)  (H(k)  P"(k)  H'*'(k)  4 R(k))‘* 


F*(k)  - (1  - K(k)H(k)|  P'(k)  (44) 

x*(k)  ■=  x'(k)  * K(k)  Lv(W)  - HfK)x  (k))  (46) 

where 

P » covariance  matrix 
X “ state  vector 
y = measurement  vector 
H taeasurt>ment  matrv 
i > transiUoD  mat’^ 

Q a process  noise  covarlunce  matrix 
K “ filter  coefficient  matrix 
R - measurement  noise  covariance  matrix 

This  section  la  devoted  to  methods  of  solving  these  equations,  or  equivalent  equations.  In  a computationally 
efficient  manner  for  a real-time  computer  using  fUcd-polnt  ariihmcUi;. 

A Fortran  computer  program  that  simulates  fixed-point  srlthmetlc  with  s specified  word  length  was  used  to 
develop  the  algoriUims.  The  fUod-polnt  rjsulto  were  compared  with  Identical  computatluns  perfor-ied  with  double- 
precision  floating-point  srltlimetic.  The  simulation  program  doubled  as  a source  of  check  problems  for  the  tssembly 
language  real-time  program 

S.  1 SCALING 

If  the  fUter  equatlona  (Eq  (4i;  through  (45))  are  Xo  be  solved  In  a fixed-point  digital  computer,  all  variables  In 
thcr;  eq""tlcTis  must  be  scaled  U'  values  leas  than  one.  Scaling  of  the  covariance  matrix  repre?«o*.t  t*'»  — 
difficult  prolOem  bacause  of  the  very  large  range  In  covariance  matrix  values.  1 he  posltlno  error  variance  can  grow 
unDvond*^,  yet  the  resolution  is  required  to  a few  feet.  As  anoUier  exampie,  assume  Initial  illt  or  azimuth  error 
variance  Is  (6  dc7’v>es)^  and  the  desired  resolution  Is  (0.  4 sec)^,  so  that  the  range  Is  1:2  x 10^  v/hich  Is  barely  within 
the  capability  of  a 32-blt  i-.ord.  However,  the  Kalman  filler  has  succerafully  operated  with  an  Inertial  navigatlco 
oystem  \xelt^  24-blt  worue  for  thn  covariance  matrix.  The  filter  haa  been  siiccessfully  stmu'xted  with  a 21-blt  word 
! length.  However,  the  esme  simulation  fiUied  st  IS  bite.  The  FU-111  covariance  matiix  is  held  In  double  precision 

j words  with  a 16  -btt  v,ord  length. 
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Notice  that  all  filter  »vHUiMoos  (f.q  (-11)  through  (t  jj)  ate  uei  handed  when  matricea  P,  (j,  aial  R are  multiplied 
Uy  a fU-gle  aoalar  pcrasieter.  K.  f ia  called  the  8hlfttog-pol>n  aoaie  aitd  le  choaen  to  make  the  largest  dlagotial 
t'leraeot  of  P equal  i/2.  K Is  reooruputed  on  bju’I\  filler  cjrvlr  as 

- Mex  Je,  1 = 1,  H.  3--.n|  (4il) 


This  Bli^rlthta  autumaUcal'y  keeps  E > 1/2.  Mattlc.^h  H and  y are  mulaplled  oy  E before  use  In  each  IMter  cycle. 

Thi*  sluFUDg-po>nt  scale  alloiv-i  tiic  covarlac;c  matrix  to  have  a large  dj-namlc  range  with  a relatively  small 
word  IcTigth,  The  covariance  mhi-lx  la  effectively  held  as  lloatlng-pulnt  nunibei-s  but  with  a common  exponent.  This 
In  much  simpler  than  performiag  full  noatlng-polnl  ailthmotlc.  The  relative  scaling  of  Ihe  covariance  matrix  is  very 
Im^'Oi'tant  In  order  to  mai.atalr.  ua  apprri.xiaiately  equal  scaled  covariance  diagonal.  Uelatlvc  scaling  la  equivalent  to 
scaling  the  transition  matrix-  Kclat.vc  scaling  was  emplrlchlly  chosen  through  simulation  of  a wide  variety  ol  flight 
profiles. 

A slmpllfliHl  8hUilr.g-pcl.''t  ectle  Ks  possible  for  stationary  alignment.  In  this  case,  the  measurement 
covariance,  (UPH  * * K),  Is  scaltir  and  is  monotimlc  nonlncreaslog.  At  each  llltcr  cycle  P,  Q,  and  U arc  normalized 
by  OIPII^  ' R)  before  comjxitlng  the  filter  coefflclenta.  This  matntalna  optimum  scaling  on  the  covariance  matrix 
and  also  simplifies  the  filter  ct.-.’Jflclccit  computation,  since  the  normalized  (llPll^^  • H)  Is  unity. 

3.2  STATE  VECTOR  AJ:D  COiARlANCE  EXTliAPOLATIO.S 

The  state  voc*or  and  covarlnnce  extrapolation  can  be  pcrlormed  by  Eq  (11)  and  (12).  This  is  the  translUou 
matrix  Icohnique.  C ovarla/ice  e.xtrapolutlou  by  direct  Integration  of  the  matrix  RIccatl  equations  was  attempted  when 
the  mecljLiilzatlo.o  wsa  Oral  coveloped.  It  was  found  that  numerical  integration  error.,  can  cause  the  covariance 
matrix  to  fall  to  be  non-negauve-doflnlte.  For  e.xamplc  the  rectangular  inb'giatlon  of  the  mntrl»  RIccaQ  ecjuatlon 
does  net  preserve  th-;  ncn-nogstlve-deflnlte  property.  However,  the  transition  matrix  technique  docs  preserve  non- 
negative  deflnltonchr  rcr.'srdless  of  the  approximations  In  computing  the  transition  matrix  (Ignoring  Uic  truncation 
er>ora  In  the  ■oatrl  < product). 

The  ine^-bsnlzatlon  that  Is  used  does  not  explicitly  compute  the  Iransltion  matrix.  Instead,  the  state  equiUon 

X “ F X (iu; 

Is  numerically  lutegrated.  Covariance  extrapolation  Is  perfonued  by  lix-ating  each  row  of  the  covariance  matrix  as 
a stale  vector  and  irumcrloally  Integrating  It  using  Eq  (19).  The  process  is  then  rcpesicd  by  ttvatlng  cac.i  column  of 
the  resulting  matrix  as  « state  vector  and  again  nuiiurically  toU'g>iiU''.g.  Note  that  this  Is  equivalent  to  C'  1’  4^  . 

Ptxx;t83  nulsc  covatiauce,  Q,  Is  a convolution  integral  Uvi..ied  by  stale  equation,  Kij  (1), 


Q(k.  k-1) 


4 (l^.  t)  t'.fl)  S(f)  g’’  (t)  t)  dt 


S(t)  - Cov  (u(t)| 

which  can  be  approximated  by  trapezoidal  Integration  as 

Q(k,  k-1)  - -7  l«(k,  k-1)  G(k-l)  y(k-l)  G^(k-l)  4>^(k,  k-l)  . C(k)  S(k)  G^(k) ) (il) 

where  T ■ *v  ~ S 9®'* fI*^**^^  extrapolation  Is 

P“(V>  - 4(k,  k-1)  (pV-I)  • G(k-1)  S(x-1)  C^(k-1)  1 4^{k.  k-1)  • ^ G (k)  S(k)  (k)  (52) 

The  matrix  products  tnvolvlrg  4 are  performed  by  state  equaUon  Integration  as  described  above.  S Is  a diagonal 
matrix  and.  In  nnest  cases.  Is  independent  of  k.  G Is  usually  on  Identity  nratrlx  in  the  Ini-rtiar  nnvlgaJon  apullcatinn. 

CooBlderable  effort  has  been  spent  oeveloptng  an  efficient  algorithm  tor  Ihr  Integration  ol  the  state  equation. 

T nrpezoidai  Integration  with  an  average  coefficient  matrix  la  used.  The  general  solution  Is 

S “ *k-i  • T^<’‘k  * *k-i>  <"’3> 

*k 

F - y F (t)  di  (51) 

*K-: 


Mo 

The  FB-lll  itate  vector  li  loternted  uilng  19  multlAUr'a  0 one-b!t  right  «MfU.  Tbl*  nomperep  with  70 
multl|>ll«e  In  • (19  x 19)  traniltlcm  nutrlx  extrapoUUon  aamunlng  a (7  x 10)  eubmatrlx  ol  non-zero.  liori-unUy 
elemocta,  A truncated  algorithm  for  computiog  the  tranalUon  matrix  will  probably  r^ault  In  Rome  zeroa  In  the 
(7  X 1C)  BubmatrU.  T)>«  oompleta  covariance  matrix  and  atata  vector  extrapolation  req[ulre  27  vector  extrapoUtlona 
ualcg  tillLer  the  trzneitlon  matrix  or  dlreot  integratton. 

The  einclency  of  the  Integration  algorlthra  reltea  directly  on  the  aparee  coefficient  matrix.  The  FB-lll 
IntegraAlon  algorithm  utei  a combinattcn  o5  rectangular  and  tk-apezoliial  integration  to  extrapolate  the  v-equatlDoe 
where  the  error  atates  are  olowty  time-varying  with  approximately  a 24-hour  period.  Complete  trapezoidal 
Intagratloc  la  uaed  on  the  poaUlon  and  velocity  equadoca. 

Integratiuo  errora  for  the  trapezoidal  Integration  algorithm  haa  boon  acceptable  for  cycle  Umea  aa  large  au  24 
•aoonda  aa  demonatrated  by  both  computer  almulattou  and  actual  flight  test.  Th  i Integratloa  error  haa  also  beer 
computed  analydoaHy.  The  trapezoidal  Integratian  algurltlun  ta  aeftned  by  Fq  (53)  and  (54'  which  can  be  aolved  for 
x(t)  uoing  a Taylor  aerlea  expanaion  of  F.  The  exact  solution  la 


x(t) 


X(0)  4 


1* 


x(»)  d I 


(55) 


whlcli  la  alao  solved  for  x(t)  using  Tsylor  series  expanalons  . x(-)  and  F( ' ).  The  trapezoidal  Integration  error, 
6x(t),  is 


6x(l) 


(F(o)^  4 F(o)  F(o)  - F(0)  F(o))  4 . . . j x(o) 


(56) 


For  cooipKiisoo  tbo  vector  urrur*  the  Diat^ix.  ext>oLhenliBJ  expansion  of  V , is  computed.  1*he 

transition  matrix  is 


{a  1 £4  2 

♦ F + 


24  ' 


♦ ft,  o)  ' 

and  the  state  voedor  error  at  time  t,  using  «(t.  0)  instead  of  Eq  (55).  In 
6x(t)  - ( (F  (o)  F(o)  - F(o)F(o))t^  ♦ . ■ ■ | x(o) 


(57) 


(56) 


Truncating  the  matrix  exponential  expansion  at  the  second  Older  term  yields  aa  addlUonal  Lilrd  order  error  term 
(i/f.)  F(ow  t^  x(0)  which  1*  larger  thttn  the  traoeroidil  error. 

in  addition  trarozoldal  integrauun  using  endpoint  values  for  coefficient  matrix  F(t)  rather  than  the  integrated 
value  f has  a ntate  vector  error 


6x(l) 


F(o)  F(o)  4 2F(o)  F(o)  4 F(o))t 


•1  x(o) 


(59) 


This  algorithm  Is  net  attractive  because  It  has  a third  order  error  term  p report" onal  to  which  may  cause  difficulty 
In  a highly  maneuvering  aircraft. 

3.3  STATE  VECTOR  AND  COVARIANCE  RESET 


Ihe  reset  equations  can  be  performed  by 
-1 


K = 


D 


k~  - Kj, 


- P"  - ItHP 


(60) 

(61) 

(62) 


The  first  problem  encountered  when  Impleaientlug  the  equations  In  a cu.ji{>ut«r  with  fixed-point  erlthmetic  is 
BcaUng  the  tU^r  coefficient  matrix,  K.  TTin  values  of  the  filter  coefficient  matrl*  v«ry  grestly  with  flight  prvfilc. 
Since  the  matiljc  Is  found  by  ratios  of  covariance  elements,  the  maximum  values  ar\<  difficult  to  predict.  The 
mechanUatloo  used  avoicU  the  scaling  problem  by  oot  explicitly  computing  tbe  filter  coei'Dclent  matrix.  Instead,  the 
state  rector  and  covariance  mati-lx  nre  reset  directly-  The  inecbanlzaUon  that  has  been  irr.pluuicnted  Is  restr1''ted 
to  two  muasuremeota  at  a time. 


A more  oocveoleut  computational  form  Is  obtained  by  defining  some  suxiUary  matrices 
f ^ P"H^ 
d ft  H f 4 R 
So  tt.e  coefficient  matrix  Is 
K = f d‘* 


(63) 
(6  4) 

(6f.) 


To  svoju  Dkunrricsi  problems  in  the  matrix  Inverse,  tlie  measurcroent  vector,  y.  Is  transformed  onto  axcG  In  wtf^h 
the  rneaeurements  are  uncorrelated,  y*. 


I 

u 


= By 


(66) 


(67) 


where  B is  fee  trenaformatton  matrix.  It  (ollowa  that  d ia  tranaformed  into  a diagonal  matrix,  d*, 
d*  - B d 

A almple  choice  for  the  tranaformatlon  matrix  B la 


where  d^^,  d„j,  d^.,  are  the  elements  of  d.  f and  K are  also  transformed 

f*  - f 
K*  = t*  d*"^ 


(68) 


(09) 

(70) 


The  state  vector  and  covariance  reset  equations  can  then  be  expressed 
r*  d*“^  y* 


/NV  A- 

X - X 


(71) 


p"  p"  - 

f d*'^ 

(72) 

The  computational  detail  can  be  more  clearly  seen  when  expressed  in  scalar  form 

A A - 

Xi  = Xj  - 

^’ll^’l  ^*12^2* 

(73) 

*^11  ^22 

p*“  li  p"  - 

t)  ij 

^*11  ^'*22 

(74) 

1.  j = 1.  2, 

3 • ■ -N 

By  perlormlng  the  multiplication  first  to  generate  a double-length  product  and  then  dividing  with  the  double-length 
dividend  to  give  a single-length  quotlnent,  truncation  errors  arc  mlnlmlr.cd  and  overflow  problems  arc  avoided.  If 
the  filter  coefficients  were  explicitly  computed,  the  divide  would  be  performed  before  the  multiply.  This  requires 
twice  as  many  truncation  operations. 


The  computational  load  of  this  mechanization  is  greater  than  the  conventional  one  because  of  the  additional 
divides.  This  is  felt  to  b. ■ justified  by  the  case  of  scaling  and  the  greater  numerical  precision.  Assuming  a 
13-clement  state  vector  end  2 measurements,  and  starting  with  the  matrices  f and  d,  this  mechanization  requires 
379  multiplies  and  379  divides.  By  comparison,  the  conventional  mechanization,  which  explicitly  computes  the 
filter  coefficient  matrix,  reciuircs  -I.IH  multiplies  and  4 divides  for  the  same  computation.  The  computation,  in 
either  case,  can  be  reduced  by  only  computing  a triangle  of  the  covariance  matrix. 


Covariance  matrix  symmetry  Is  forced  by  storing  the  lower  triangle  Into  the  upper  triangle.  This  is  sufficient 
to  avoid  numerical  problems  and  Is  somewhat  simpler  than  the  averaging  technique 

P’  = |(P“  ■ P'S  (75) 


•1.  CONCLUSIONS 


A number  of  techniques  used  in  the  practical  implementation  of  the  Kalman  filter  arc  presented.  Techniques  to 
minimize  the  computer  re<(uircmcnts  are  emphasized  Including  simplifying  the  filter  model  and  using  algoritlims 
suitable  for  fixed-point  arithmetic.  All  of  these  techniques  have  been  proven  by  many  flight  tests  on  several 
applications  at  Autonctlcs. 


HKIKBKNCKS 


(li  I,eond.?s,  C.  T.,  (.01(1.0000  and  Control  of  Aerospace  Vehicles,  McG raw-11111  Bewk  Company, 
Inc.  . New  York, 


ACKNt  )\V  I.LDO  KMKNTS 


I'he  rlevclopment  of  the  Kalman  filter  mechanization  dcscrllK'd  here  was  a teatn  effort  involving  many  engineers 
irom  the  Autonctlcs  (irimp  of  Itockweli  international.  Major  contributions  were  made  by  Dr.  T.  \V.  DeVries  and 
.'Ir.  ft.  Schmidt.  Or.  Ort  rlrs  made  significant  contrltjutlons  to  error  modeling  and  overall  refinement  of  the 
(T.  •' luini/at'.  ir..  Mr.  S'  hmIdI  dl•v<■!opl•^l  many  of  the  basic  fomputallonnl  algorithms. 


y I 


CXPtP.!i(;CtS  .■JiTH  7i:‘  fl- 1 NAVlG^IO?'  FIiTfR 

Ur.  ,!onn  t.  Pergescr 
Tin.  Boc-InQ  Cookery 
Seattle.  Uashingtcjo  USA 


SUF.iARf 


This  lei.torc  •.liscusso!;  cock  p.--actical  aspects  of  Kairnan  f*.  Iter  Jesion.  Topics  presentee  inriy^e  error 
n>odei  aetinitlon,  softwire-impleienlat  ion  considerations  ard  flight  test  verlfiratin.  .Mthoogh  S-1  ravi- 
rati-.n  Ml.c-  experiences  are  emphasized,  the  discussion  is  applicable  to  KalT.jti  filter  design  for  any 
lone-ringe.  hig--:pt-ed  cmise  vehicle  witn  simi  lar  navigation  sensors.  Frun  a crarti  sal  standpoint,  the 
principal  c.ontribut  Ion  of  this  lecane  is  perceived  to  be  a discossion  of  1 nerlial.  platform  slew-induced 
phenomena  and  their  iiipl icati On  for  filter  design. 
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1.  introduction 

Tfie  B-1  is  <n  Intercootinenti al  weapon  system  which  is  capable  of  delivering  both  air-to-ground  missiles 
and  gravity  weapons.  Rockwell  International  1c  bL'ldlny  the  airframe.  The  Boeing  Aerospace  Company  Is 
the  Avionics  System  Integration  Contractor  (ASIC).  The  offensive  avionics  system  contains  the  aircraft's 
navinatlon  and  weapon  delivery  hardware  and  software. 

fhis  1ectu~  disi-jsses  the  Kalman  filter  which  the  ASIC  has  designed,  Itnpleeiented,  and  fligl.t  tested  for 
B-1  navigaiion-sensor  data  integration.  Section  i Is  an  overview  of  the  B-1  navigation  system  configura- 
tion ond  Kalman  filter  design.  Section  3 sunmarlzes  the  ASIC'S  analytical  approach  tc  filter  design,  while 
Scuioi.  4 discusses  some  practical  aspects  of  filter  Implementation.  Section  5 presents  some  Holloman  Air 
Far..f  Ua'.e  flight  test  data  arj  compares  design  assumptions  with  real-system  behavior.  Although  the 
s;c'.;f1c  analyses  and  exaaples  cited  In  these  sections  arc  drawn  from  the  collective  e.xperlences  of  the 
ASIC's  B-1  Navigation  and  Weapor  Delivery  Group,  the  general  discussion  Is  applicable  to  Kalman  filter 
design  and  Implementation  for  any  loig-range,  high-speed  cruise  vehicle  with  similar  nav'gation  sensors. 

This  lecture  does  not  discuss  B-1  performance  capability. 

2.  6-1  Navigation  System  Overview 

2 1 System  Description 

T»ie  B-l's  Integra' ■'d,  multisensor  navigation  system  is  shown  schtmatl 'al ly  in  fig.  1.  The  computer(s)  and 
interface  element:,  in  this  figure  represent  the  Avionics  Co.  trol  Unit  Complex  (ACUC),  wh'ch  provides  data 
processing,  interfacing  and  real-time  control  functions  for  the  avionics  hardware.  The  software,  suppilej 
by  Br'lng,  Is  written  In  Jovial  J3B  language.  There  are  two  Singer  Kearfott  SKC-2070  computers  in  the 
complex.  One  of  the  computers  Is  dedicated  to  navigation-related  functions;  the  other  to  weapon- dell  very 
functions.  However,  each  computer  can  pe-.'orm  al!  of  the  navigation  and  weapon- del  1 very  functions  1f  the 
other  one  fai  Is . 

2.1.1  Navicatlon  Sensor  Hardware 
Ine rtlal  Measurement  Unit 

The  Inertial  measurement  unit  (IMU)  Is  the  L<tton  AN/A.lN-17  (Lh-15),  a three  g.mbal  platform  with  two  2- 
degree- of- freedom  gas  bearing  gyros  and  three  floated- pendulum  acc.elerv  eters . For  the  B-1  application, 
the  Inertial  platform  Is  stabilized  in  a local-level  wander-azimuth  orientation  through  full  inertial-rate 
level-axis  to^xfuirg  ana  vertical  earth-rate  aj ' auth-txis  torquing.  There  are  two  LN-15’s  on  the  B-1. 

Ooopier  Radar 

The  Doppler  radar  unit  is  either  the  stabi lized-antenna  (glmbaled)  Singer  APN-  S5  or  the  flx'^d- antenna  llyan 
APh-200.  For  the  B-1  application,  both  Dopplers  output  groundspeed  and  drift  angle  (the  angle  between  the 
groundspeed  vector  and  the  projection  of  the  aircraft  centerline  on  a local-lcvcl  plane).  The  APN-18S 
pnivldes  these  outputs  directly,  whereas  the  APN-200  employs  a digital  Interface  adapter  unit  (mini -computer) 
for  equivalent  groundspeed  and  drift-angle  det^'minatlon. 

Position-Fix inq  Devices 

The  forward-looking  radar  (KLR)  is  the  General  Electric  AN/APQ-144.  The  electio-optical  viewing  system 
(EVS),  supplied  by  Seeing,  contains  an  infrared  sensor. 

Central  Air-Data  Computer  and  Gyro  Staui 1 izatinn  Subsystem 

The  Central  Air-Data  Computer  (CAOC)  supplies  altitud-'  and  airspeed  Information  to  the  Afijc  for  yertlcal 
channel  damping  and  deadreckoning  navigation.  The  gyro  stabilization  subsystem  (GSS)  supplies  heading  and 
attitude  reference  data  for  in-air  IMl>-al  1 gnment  initialization  and  deadreckoning  navlration.  The  C.ABC 
and  GSS  are  part  of  the  B-I  a1rc.  aft's  a1r-yeh1cle  equipment.  Other  offensive  avionic:,  sensors  on  board 
the  B-1,  but  not  shown  In  Fig.  1,  ar--  the  Honeywell  AN/APN-194  radar  altimeter  and  the  Texas  Instrunent 
AW/APQ-145  i'erraln-Fol  lowing  Radar. 

2.1.2  fiavlgotiun  Node  Heirarchy 

The  B-l's  primary  navigation  mode  is  Doppler-lnortiel.  Doppler  and  airspeed  deadreckoning  are  backup  modes. 
Figure  2 displays  the  navigation  mode  heirarchy  which  is  Implemented  in  the  B-1.  Kalman  filters  are  used 
for  navigation-data  processing  In  the  Ine'tial  modes  and  for  Inertial  platform  ground  alignment  and  auto- 
callbratlon.  There  are  two  navigation  filters  on  the  B-1,  one  for  each  Inertial  measurement  unit.  T..e 
filters  operate  indepcntienily  of  each  other.  There  is  no  mutual  aiding. 

2 . 2 filter  S tructui  e 

In  approaching  the  task  of  designing  a navigation  filter  for  the  8-1,  the  ASIC  first  looved  at  tlie  critical 
performance  requirements  of  the  navigation  system  during  a typical  mission.  The  mission  In  Fig.  3 Is  a 
const  ant- velocity  great-circle  flight  path  with  an  initial  In-ai  ' alignment  segment  over  land,  a subsequent 
cruise-out  portion  over  water,  and  extended  penetration  over  land.  Position  error  Is  a critical  perfonnance 
parameter  at  landfall  for  an  Intei  continental  booter  since  the  probability  nf  landfaT  pos1t1on-f1.\  acquisl- 
♦ipn  Is  Inversely  proportional  to  landfall  position  error.  Both  position  end  velocity  errors  are  critical 
performance  parameters  for  weapon  delivery,  since  accurate  Initialization  at  launch  is  vital  to  acnieving 
acceptable  impact  CEP  (circular  error  probabi  1 i ty ).  This  Is  particularly  true  for  ai r- launched,  inertially- 
guided  missiles  such  as  SRAM  (Short  Range  Attack  Missile). 

The  performance  requirements  and  mission  scenario  essentially  dictated  the  structure  and  dinensicnal  1 ty  of 
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the  6-1  navigation  filter.  (Ttie  filter  equations  are  shown  In  Fig.  4.)  for  e«airple,  acceptable  position 
accuracy  at  landfall,  after  many  hours  of  over-water  flight,  requires  good  gyro  performance  - performance 
which  is  only  obtainable  through  p?-ecise  and  periodic  ground  and  In-air  calibration.  Hence,  three  gyro 
fixed-drift  elements  are  Included  In  the  state  vector.  Likewise,  acceptable  velocity  accuracy  during 
penetration  requires  good  Doppler  performance,  and  Doppler  scale-factor  and  drlrt-anqle  errors  are  modeled 
ir.  the  filter.  Consequently,  the  state  error  vector  In  Fig.  5 was  selected  alrost  at  the  ouiiet  of  the 
filter  design  process.  The  state  error  vector  contains  13  level-channel  er-ror  elements  and  4 verticil- 
channel  elements.  The  verticul-channul  elements  are  Included  on  the  basis  of  E-1  altitude  and  vertical- 
velocity  accuracy  requirements  during  penetration. 

Figure  6 displays  the  control  vector,  as  It  is  currently  implemented  In  the  8-1  navigation  filter.  This 
vector  represents  a set  of  corrections  which  are  applied  mathematically  to  the  nav1gat1ori-sysfe.ii  posttiun 
and  velo'^lty  equations  and  electro-mechanical  1y  (through  gyro  terqulng  corrections)  to  the  inertial  plat- 
form. The  control  vector  also  contains  Dopplei  scale-factor  and  drift-angle  error  estimates,  as  well  as 
a vertical-acceleroneter  bias-error  estimate,  which  are  acctanulated  and  used  tc  correct  llie  Doppler  inputs 
to  each  navigation  filter  and  the  vertical  accelerometer  outputs  from  each  Inertial  meas'jr-einent  unit  to 
the  vertical-channel  mechanUatlon  equations.  The  CADC  altitude  output  is  not  corrected  via  feedback  u' 
the  estimated  baro-altimeter  bias  error  and  this  error  element  does  not  appear  In  the  control  vector.  In- 
stead, the  estimate  of  this  error  is  used  In  forming  the  residual  at  an  altitude  update. 

3.  Analyt.cal  Aspects  of  Filter  Design 

The  critical  design  phase  of  the  6-1  filter  design  process  involved  the  development  of  a complete  error 
model,  the  synthesis  of  specialized  computer  program  sensitivity  analysis  and  performance  verification 
tools,  and  the  refinement  of  the  preliminary  suboptimal  filter  design  When  the  B-1  Avionics  contract  was 
awarded  in  April  1972,  elements  of  a basic  suboptimal  filter  design  methodology  had  emerged  in  the  litera- 
ture. For  ex.j.iple,  the  C-5  filtc'  design  experience,  as  recorded  in  [1],  was  helpful  in  deve.nolng  a 
basic  approaih  to  the  design  task.  Later  on,  tnc  error  propagation  and  update  equations  of  [2]  were  use- 
ful in  checkiig  out  a suboptimal  filter  covariance  analysis  program.  But  there  is  a vast  difference  be- 
tween devising  equations  afid  constructing  computer  programs  for  suboptimal  filter  analysis  or  system  simu- 
lation and  evolving  confidence  that  these  equations  and  computer  programs  adequately  represent  i‘eal-sysiem 
behavior.  This  section,  therefore,  emphasizes  some  analytical  aspects  of  the  filter  design  process  that 
proved  to  be  of  particular  practlral  significance. 

3. 1 System  Error  Models 

The  term  "error  (acvlel"  in  this  lecture  denotes.  In  general,  a raathematicel  representation  of  navigation- 
sensor  Imperfections  and  environnvental  errors.  The  term  also  denotes  a set  of  linear  differential  equations 
vhith  govern  the  transtoTiJtIcn  - c mipping  - of  these  errors  (as  well  as  navlgatlisn  system  Initial-condi- 
tion errors)  into  carrier  position,  velocity,  and  heading  errors  as  a functior.  of  t1.7.c.  Gyro  drift  and 
accelerometer  bias  fall  under  the  category  of  sensor  Imperfections;  gravity-vector  deflections  from  the 
local  vertical  and  ocean-surface  motion  arc  examples  of  environmental  effects  which  adversely  Impact  navi- 
gation system  performance.  The  error-propagation  equations,  cn  the  other  hand,  are  derived  fro.’,  the 
kinematic  relationships  between  vehicle  inertial  acceleration  components  ond  rotating  reference  axes. 

Since  tne  essence  of  Kalman  filtering  for  applications  such  as  the  B-1  Is  a statistical  weighting  of 
Inertial-navigator  and  Ooppler-veloc i ty  or  posi tion- fixing  errors,  the  formulation  of  realistic  error 
models  is  central  to  f11*or  design. 

3.1.1  Navigation-Parameter  Error  Definition 
Dynamics  (F)  Hatrlx 

The  usual  approach  to  deriving  Inertial- system  error- propagation  equations  Is  tc  take  first-order  variations 
of  the  mechanization  equations.  This  technique  leads  to  the  "ps i -a.ngle"  error  model  In  Fig.  7 for  a local- 
level  wander-azimuth  mechanization,  where  the  errors  are  defined  as  vector  differences  between  computed 
and  true  values  resolved  along  the  true  (or  ideal)  navigation  axes.  The  vector  difference  error  may  be 
represented  mathematically  by 

- vj  - vj  , (1) 

where  V Is  a vector  and  "T"  and  "C"  denote  true  and  computer  coordinates,  respectively.  An  alternate 
approach  defines  the  basic  error  quantities  as  vector  component  differences 

OV  • . (2) 


where  AV  has  no  superscript  since  it  does  not  represent  a set  of  vector  components, 
for  example,  the  three  comp^ents  ‘ vehicle  velocity  error  are  d?flr.ed  as 
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With  this  approach, 
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The  component  dliference  definition  leads  to  the  '’phi-angle'  er.>-or  model  1n  F1g.  8 for  a local  level  wan- 
der-azimuth mechanization,  l.ie  velocity  errors  In  Figs.  7 and  6 are  relateo  by  the  expression 


6V^  - 6vj  - «6x  v[  (4) 

ttie  trv«  v«1oc1ty  and  <e  denotes  the  set  of  coaputer-to-true-exls  nisal ignaent  angles. 

Reference  [3]  derives  a generalized  version  of  the  error  model  in  Fig.  8,  which  Is  applicable  to  space- 
stable  piatforws.  Reference  [4]  provides  a fcraal  comparison  of  both  approaches.  The  latter  reference 
shows  that  the  *ps1-ang1e"  error  model  evolves  from  the  assunptlon  that  the  navigation  e^untlons  are  solved 
In  the  cooiputer  fraw^  whereas  the  “phi -angle"  model  evolves  from  the  assueptlcn  that  the  navigation 
equations  are  solved  In  an  Ideal  frame.  The  error  model  In  Fig.  8 has  one  more  error  elenient  than  the  one 
In  Fig.  7;  this  element  Is  sa^,  which  represents  a computer~ax1s-to-true-ax1s  azimuth  misalignment. 

Heas  jre»ie<it  (H)  Ksttix 

The  vector-difference  and  component-difference  approaches  to  error  dynamics  derivation  also  lead  tr  dlffei- 
ent  measurement  matrix  fonaulatlons  for  a Ooppler-alded  Inertial  navigation  system.  The  velocity  measure- 
m»nt  matrix  derived  from  the  component- difference  definition  Is  shown  In  the  upper  half  of  Fig.  9 for 
Measurement  processing  In  navigation  axes.  In  deriving  this  mscrlx.  the  velocity  component-difference 
definition  may  be  used  In  conjunction  with  the  velocity  divergence  components 
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where  the  V 's  are  computer  or  Inertial  system  velocities  in  computer  coordinates  and  the  Vq  's  represent 

Doppler-  '■1  velocitv  components  in  platform  coordinates.  The  measurement  matrix 
follows  fron  the  relationships 
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represents  Doppler  scale- factor  and  drift-angle  errors. 
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where  aj  Is  the  significant  component  of  >.  An  expression  for  velocity  divergence  equivalent  to  the 
fORsulatioriS  in  Fig.  9 Is  given  in  [4]. 

The  Doppler  r«iasur?™o1;*  may  also  be  processed  in  local-level  «»es  which  are  parcllel  and  perpendicular  to 
the  gruundspeed  vector.  The  n»dsureme<it  fuatrix  in  the  lower  half  of  Fig.  9 utilizes  groundspeed  and  drift- 
angle  directly  as  observables.  In  this  matrix,  the  symbol  V.  represents  groundspeed  and  It  has  been  assumed 
that  Is  positive  about  Z up  and  i Is  positive  about  Z down. 

The  "phi-angle"  error  dynamics  matrix  In  Fig.  7 and  the  Yv^/tvy  form  of  the  rneasurerent  matrix  nave  been 
Implemented  In  the  B-1  navigation  filter.  The  practical  basis  for  this  Implementation  Is  discussed  In 
Sections  4.1.1  and  4.4.3. 

3.1.2  Navigation-Sensor  Error  Sources 

The  state  vector  In  Fig  5,  the  error-dynamics  matrix  in  Fig.  8,  and  the  measurement  matrices  In  Fig.  9 
are  subsets  of  a real-world  error  model  or  "truth  eodel"  which  was  used  for  B-1  suboptimal  filter  design. 
Figure  10  suntnarlzes  the  complete  set  of  navigation-sensor  error  sources.  In  addition  to  the  Instrwnent 
errors  displayed  In  the  figure,  such  as  gyro  g-sensitive  drift,  deflections  of  the  vertical  and  random  sea- 
surface  effects  were  rodeled  as  accelercxneter  and  Doppler  noise,  respectively.  Both  of  these  errors,  as 
well  as  Inherent  gyro  and  accelerometer  noise,  were  modeled  In  the  real  world  as  exponentially-correlated 
random  variables.  Of  the  error  sources  shown,  Doppler  noise  and  accelerometer  bias  errors  turned  out  to 
be  the  most  interesting  from  a design  verification  standpoint. 

3.2  Suboptimal  Filter  Design  Tools 

A family  of  computer  program  analysis  tools  was  used  In  designing  the  B-1  navigation  filter.  An  optimal 
filter  covariance  analysis  program  Is  the  progenitor  of  this  family  and  contains  subroutines  which  are 
common  to  all. 


3.2.1  Suboctimal  Covariance  ysis  Prorjcam 

The  basic  suboptimal  filter  covariance  analysis  equations  are; 
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The  covariance  matrix  P Is  a measure  of  filter  performance  since  Its  diagonal  elements  are  the  mean-square 
errors  In  the  state-vector  estimate.  The  covariance  matrix  D represents  the  mean-square  errors  of  the 
actual  states,  Including  those  not  modeled  In  the  filter.  The  Fj.,  H , Q and  R are  filter  design  models 
for  the  error  dynamics,  measurement,  process  noise,  and  measurement  noise  matrices,  whereas  F and  Q are 
truth-model  matrices.  The  suboptimal  Kalman  gain  matrix  Is  Kj;.  The  symbols  Hi  and  H2  are  true  measure- 
ment matrices  for  modeled  and  unmodeled  states,  respectively.  The  set  of  real-world  equations  above  Is 
applicable  to  the  design  situation  where  all  states  are  reset  or  corrected  Instantaneously  after  estima- 
tion. The  equations  are  considerably  more  complex  for  non-instantaneous  reset. 


The  difference  between  the  truth-model  and  filter-model  performance  associated  with  a critical  design 
parameter  such  as  landfall  position  error  may  be  minimized  by  adjusting  the  process  noise  (Qr  matrix)  In 
the  filter  equations.  The  determination  of  process  noise  compensation  Is  an  Important  practical  aspect  of 
filter  design;  It  is,  to  a large  extent,  an  Iterative,  time-consuming  process.  The  approach  used  to  evolve 
compensation  for  the  B-1  navigation  filter  was  to  optimize  system  free-inertial  performance  by  adding 
process  noise  at  the  velocity,  tilt  and  gyro  error  levels  in  the  Qc  matrix  and  then  to  optimize  system 
Doppler-Inertial  performance  Independently  by  adjusting  Q^.  values  at  the  Doppler-error  level. 

3.2.2  Navigation  Simulation  Program 

A navigatlotr system  simulation  program  is  functionally  displayed  In  F1g.  11.  This  program  simulates  the 
operation  of  an  Integrated  multisensor  navigation  system.  The  filter  moduleof  this  program  Is  similar  to 
the  filter  side  of  the  suboptimal  filter  co.ariance  analysis  program  except  that: 


(1)  Error  propagation  is  accomplished  via  a transition  matrix  (as  In  the  airborne  computer)  rather  than 
by  solving  the  Ricatti  equation. 

(2)  The  simulation  contains  state-vector  propagation  and  system- correction  equations. 


Also,  In  the  simulation  program,  the  actual  navigation-system  mechanization  equations  replace  the  truth 
model  covariance  propagation  equations.  For  a given  set  of  (signed)  error  Inputs  to  these  equations,  the 
program  will  simulate  system  performance  for  a given  filter  design. 

Although  both  the  covariance  analysis  and  the  simulation  programs  were  Indispensable  to  the  B-1  filter  de- 
sign process,  the  practical  value  of  the  simulation  In  verifying  mechanization  integrity  and  in  Identifying 
the  cause  of  flight-test  anomalies  cannot  be  over-emphasized. 


3.3  Pseudostates  and  the  Ground- Alignment  Filter 


Inspection  of  the  differential  equations  which  comprise  the  navigation- system  error  model  snows  that  only 
linear  combinations  of  certain  error  states  are  observable  [5].  These  linear  combinations  are  sometimes 
called  pseudostates.  For  example,  from  the  error  equations* 
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where  and  are  level-accelerometer  biases,  and  4 are  the  original  platform  tilt  variables,  and  g 
is  the  magnitud'  of  the  effective  gravity  vector. 


Some  terms  in  the  standard  error  equations  have  been  omitted. 
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Drift  Pseudostates 
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where  and  are  inertial-angular-rate  components  and  Cy,  and  are  gyro  drifts. 

The  pseudostate  constructions  show  that  accelerometer  bias  errors  m^y  be  deleted  from  the  filter  for 
operation  in  the  airborne-alignment  and  navigation  mode,  where  the  vertical  platform  torquing  rate,  u , is 
essentially  the  vertical  component  of  earth  rate-  For  this  condition  the  terms  containing  accelerometer 
biases  in  the  drift  pseudostates  are  much  less  than  the  inherent  gyro  drifts.  Conversely,  however,  the 
pseudostates  also  imply  that  level-accelerometer  bias  errors  become  observable  when  the  platform  vertical- 
axis  torquing  rate  is  very  large,  as  it  is  during  platform  slew  (about  100  times  earth  cate). 

During  the  preliminary  design  phase,  a decision  was  made  to  implement  a Kalman  filter  for  B-1  gyrocompass 
or  ground  alignment  in  order  to  maximize  unaided  inertial  system  performance.  Initial  covariance  analysis 
studies  in  this  area  with  implicit  platform  slew  were  highly  encourgaging.  Subsequent  covariance  analyses 
with  actual  slew-rate  modeling  were  disastrous  — unless  accelerometer  biases  were  modeled  explicitly  in 
the  filter.  Simulation  studies  confirmed  the  pseudostate  implication  that  accelerometer  biases  are  observ- 
able during  slew.  Figure  12  is  simulation  data  which  illustrates  this  estimation.  In  practice,  the  appar- 
ent accelerometer  biases  are  themselves  linear  combinations  of  inherent  bias,  input-axis  misalignment  and 
vertical-gyro  torquer-axis/platform  level-axis  non-orthogonality.  The  subject  of  real-system  slew-induced 
phenomena  is  discussed  in  Section  5.2. 

4.  Practical  Aspects  of  Filter  Implementation 

There  are  many  Important  practical  considerations  in  designing  and  implementing  a Kalman  filter  for  cruise 
navigation.  Airborne  computer  capability  is  usually  the  most  critical  practical  limitation.  However, 
other  factors  such  as  operational  flexibility,  error^model  sensitivity  and  software  conmonallty  shape  the 
final  form  of  the  filter  and  its  associated  update  and  correction  mechanization.  This  section  discusses 
some  of  these  considerations  as  they  apply  to  the  B-1  navigation  filter. 

4. 1 Position  Updates 

4.1.1  Two  Azimuth-Error  Variable  Utilization 

In  its  present  configuration  the  B-1  navigation  filter  models  13  level-channel  error  states:  two  position, 
two  velocity,  four  attitude,  three  gyro,  and  two  Doppler.  Other  operational  navigation  filters  for  Doppler^ 
aided  inertial  cruise  systems  use  12  level-channel  error  states.  The  difference  is  that  the  B-1  Hlter 
models  two  azimuth-error  states:  6e^,  the  computer- to- ideal  axes  azimuth  misalignment;  and  ^ , the  platform- 
to-ideal  axes  azimuth  misalignment.  The  practical  reasons  for  implementing  two  azimuth-error  states  are 
discussed  in  the  following. 


The  B-1  inertial  navigation  system  mechanization  employs  a set  of  direction  cosine  matrix  elements  as  the 
basic  navigation  parameters.  The  direction  cosine  elements  which  define  the  orientation  of  local-level 
wander- azimuth  navigation  axes  with  respect  to  earth-fixed,  rotating  reference  axes  (Fig.  13),  are  functions 
of  latitude,  longitude  and  wander  angle  (Fig.  14).  The  errors  in  the  direction-cosine  elements  or  equiva- 
lently in  latitude,  longitude,  and  wander  angle,  are  functions  of  the  angular  position  errors,  60  and  66  , 
and  the  azimuthal  misalignment  error,  60^.  The  error  equations  have  the  form  ^ ^ 

6Cij  = 69^  Cjj  - i6y  Cjj 

6C^.  = 60^  C3j  - 69^  Cjj  (13) 

®^3j  " *®y  '-Ij  ■ 

where  the  C.jj  (i,j  = 1,  2,  3)  are  navigation  direction  cosine  elanents  and 

5X  = 50sina+60  COS  a 

X y 

6*  = (60jjCOS  a - 60y  sin  a)/cOS  X (14) 

6a  = 60^  - 5 L sin  X , 

where  x,  L,  and  a are  latitude,  longitude,  and  wander  angle.  The  6's  denote  differences  between  computed 
and  true  values. 


Equations  (13)  and  (14)  shew  that  it  is  convenient  to  retain  60^  in  the  navigation-error  state  vector  and 
to  utilize  estimates  of  this  variable  in  correcting  system  position  errors.  The  fact  is,  however,  that 
this  variable  is  omitted  from  many  navigation  filter  designs.  Both  published  (Ref.  [4]  for  example)  and 
unpublished  analyses  show  that  the  decision  to  retain  or  not  to  retain  50  should  be  influenced  by  the 
following  considerations;  ^ 
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(1)  Obs«nr<>nity 

In  the  »1r,  66  appceri  it  the  pos1t1oo-error-r»te  level  end  Is  miltlpllcitlve  with  level-velocity 
cmpcnvnts,  whireas  62  *PP**vs  at  the  velodty-error-rate  level  and  Is  aultlpllcatlye  with  lateral 
acceleration  coeponerts.  The  two  variables  are.  therefore,  distinguishable  when  the  vehicle  1$  air- 
borne. The  two  variables  are  not  distinguishable  when  the  vehicle  Is  stationary  on  the  ground. 

(2)  Velocity  Error  Definition 

The  natural  definition  of  velocity  error  in  building  sleulatlon  programs  or  In  analyzing  flight-test 
data  is  velocity  register  contents  minus  reference- velocity  conponents.  I.e..  ctaipanent  differences. 
If  the  vector-difference  definition  is  employed,  then  the  velocity  transformation  In  Eq.  (4)  must  be 
either  Incorporated  Into  the  error  awdel  directly,  or  separately  applied  when  making  position  and 
velocity  updates  and  flight- test  data  comparisons. 

On  the  basis  of  these  considerations,  and  In  vie*  of  the  fact  that  the  B-1  Is  a long-range,  high-speed 
crjise  vehicle,  the  error  model  in  Fig.  8 was  used  in  the  B-1  navigation  filter.* 

4.1.2  Update  Algorithms 

Equations  (13)  and  (14)  have  been  Implemented  In  the  B-1  Offensive  flight  Software  (OFS)  for  correcting 
navigation  direction  cosines  when  filter  estimates  of  6x.  6y  and  <62  are  available.  (The  computer-axis 
misalignment  angles,  6e  and  66  , are  related  to  the  filter's  linear  position-error  variables,  6x  and  6y, 


iiv  00  * 

by  the  relationships  66^  = - and  66  • ^. ) Equations  (13)  are  used  when  position-error  estimates  are 

based  on  Doppler  measurements,  since  posit^n-error  estimates  derived  from  velocity  updates  are  usually 
quite  small.  The  direction-cosine  update  algorithm  for  Ooppler-deri ved  u(>dates  Is  therefore 
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where  is  the  direction-cosine  transformation  from  earth-fixed  axes  to  true-platform  axes,  is  the 
direct  ion- cosine  transfonutl  on  from  earth-fixed  axes  to  computer  axes,  and  M Is  the  correction  matrix 
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When  position  fixes  are  available,  however,  the  filter's  position-error  estimates  can  be  relatively  large, 
and  the  application  of  Eq.  (15)  nay  result  in  unacceptable  direction  cosine  matrix  non-orthogonali ty . To 
circumvent  this  problem,  Eqs.  (14)  are  used  in  the  OFS  to  correct  latitude,  longitude,  and  wander  angle 
directly  at  position-fix  updates.  The  correction  equations  are 
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and  the  updated  latitude,  longitude  and  wander  angle  are  used  to  re-1n1tialize  or  re-compute  the  elements 
of  the  direction  cosine  matrix.  This  technique  guarantees  direction  cosine  matrix  orthogonality. 

An  altemvte  'K'-ectlon-cosine  update  algorithm,  which  works  well  In  the  simulation  progt*m  for  both  Doppler- 
derived  and  fix-derived  position  updates,  is 


where  N is  the  correction  matrix 
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•Another  error  model,  nhlch  might  be  suitable  for  an  application  such  as  the  B-1,  retains  4^,  t , and 
for  tne  platform  atUtude  error  variables  but  eliminates  66-  by  driving  the  true  axes  into  coincidence 
with  the  computer  axes  through  additional  azimuth  axis  torqulng.  This  error  model,  which  incorporates 
the  velocity  transformation  in  Eq.  (4),  utilizes  only  one  azimuth-angle  variable. 
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The  reason  whjr  this  elsorltha  Is  suitable  for  position-fix  updates  1$  that  N satisfies  the  orthogo- 
nality condition 


I c^j  • «j^  ' 1 (J  “ k)  01  0 (J  f k) 

nore  accurately  than  docs  M for  j • k.  The  reason  why  this  algorithm  was  not  i^lemented  In  the  B-1  navi- 
gation filter  Is  that  Of)  does  not  inprove  the  orthogonality  of  the  direction  cosine  matrix  at  a position 
update,  whereas  direction  cosine  oatrlx  re-in1t1al1zat1on  satisfies  the  orthogonality  condition  for  both 
j ■ k end  J f k.  If  an  accurate  direction-cosine  update  algorithm  Is  not  eevloyed  at  position-fix  updates, 
simulation  runs  show  that  the  errors  In  the  filter's  gyro  drift  estimates  becone  large  due  to  erroneous 
earth-rate  resolution. 

4.1.3  Position-fix  Quality  Weiphtlno 

From  both  the  theoretical  and  practical  standpoints,  the  accuracy  with  which  the  B-1  Offensive  System 
Operator  actually  OMkes  a position  fix  Is  dependent  on  aircraft  altitude,  reference-point  quality,  opera- 
tor skill,  and  other  factors.  Consequently,  the  B-1  mechanisation  Incorporates  a quality  weighting  scheme 
for  processing  position-fix  Infonnatlon  In  the  Kalman  filter.  The  scheme  Is  simple:  The  position-fix 
measurement  noise  variance,  on^,  In  the  filter's  measurement  noise  IR)  matrix  may  be  manually  set  to  one 
of  thi^  preprograwaed  values: 

Quality  1 - • 1/4  times  Quality  Z 

2 

2 - • Reference  Value 

3 - • 9 times  Quality  2 

The  operator,  therefore,  has  the  option  of  weighting  a position  fix  In  accordance  with  his  subjective 
feeling  concerning  its  accuracy. 

4.2  Doppler  Error  Model 

4.2.1  First-Order  Markov-Process  Assjnption 

The  Doppler  scale-factor  and  drift-ai.gle  bias-like  errors  in  Fig.  10  consist  of  exponentially-correlated 
and  random  constant  nr  time- independent  cononents.  The  corresponding  truth  model  Is 
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where  V Is  the  correlation  time  and  U is  vrhite  noise  with  power  spectral  density  Q.  Since  only  linear 
corMnations  of  scale- factor  or  drift-angle  error  states  a -e  observable,  these  Doppler  errors  were  original- 
ly miKSeled  In  the  airborne  navigation  filter  as  the  first-order  Markov-processes 

*D  • - 7 *0  " ^ 

with  in'tial  (over  land)  covariance  uncertainties  of 

P . P„  (21) 

0 0 0 

and  corrclatio,’-.  times  of  15  minutes.  The  subscripts  "B"  and  "N"  in  Eqs.  (19),  (20),  and  (21)  refer  to 
random-constant  and  exponent! ally- correlated  error  sources,  respectively.  The  subscript  "0“  refers  to 
composite  scale- factor  or  drift-angle  errors  as  modeled  In  the  filter. 

The  rationale  for  Implementing  a first-order  Markov-process  Doppler  model  in  the  B-1  navigation  filter  was 
provided  by  sensitivity  a.nalyses  (in  the  form  of  error  budget  histograms)  which  exliibited  the  relative 
cuTitribution  of  Doppler  exponential ly-correlated  noise  and  time-independent  bias  errors  to  system  position 
error  at  landfall  and  velocity  error  during  penetration.  The  sensitivity  analyses,  which  were  generated 
with  the  suboptimal  covariance  analysis  program,  were  based  cn  the  assumption  that  80*  of  a specified  Cop- 
ier scale-factor  error  or  equivalent  drift-angle  error  should  be  treated  as  a time- Independent  bias  and 
that  60*  of  these  errors  should  be  treated  as  exponentially-correlated  noise  (root-sun-square  to  lOOX). 

The  error  budget  histogrmas  showed  that  system  performance  was  significantly  nore  sensitive  to  Doppler 
noise  than  to  Doppler  bias. 

The  15-mir,ute  correlation  tine  was  selected  partly  on  the  basis  of  its  popularity  over  the  years  in  the 
filter-design  business  and  partly  on  the  basis  of  in-house  simulation  and  sensitivity  studies.  Figure  15, 
for  example.  Is  data  obtained  from  the  covarlasce  analysl.  program  for  a candidate  suboptimal  filter  design 
by  varying  the  real-world  Doppler  correlation  time  and  fixing  the  filter-model  correlation  time.  (In  this 
suboptimal  design  the  Ooopler  scale-factor  and  drift-angle  process  noises  were  not  set  equal  to  the 

equillbriun  values  implied  by  Eqs.  (20)  and  (21).)  The  figure  shows  that  performance  sensitivity  to 

I 

real-world  correlation  time  uncertainty  Is  reduced  by  modeling  relatively  short  correlation  times  in  the 
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filter.  The  popuUrlty  of  »he  15  minute  correlation  time  nay  be  traceable  to  Ref.  [6]  which  states,  In 
effect,  that  15  nlnutes  Is  the  least  desirable  (and  therefore  most  conservative)  correlation  time  for 
Doppler  bias  errors  In  a Doppler-Inertial  system  because  of  Schuler  effects. 

4. 2 . 2 Sea  State  Reset 

Throughout  the  B-1  navigation  filter  design  process.  It  was  asstmied  that  Doppler  performance  over  water  Is 
significantly  degraded  relative  to  Doppler  perfonunce  over  land.  Sea-surface  notion  was  postulated  as 
the  basic  physical  source  of  this  degradation,  since  Doppler  reflection  Is  relative  to  a moving  medlior. 
Although  ocean  currents  (gross  motion)  are  p<-ed1ctab1e  In  many  parts  of  the  world,  a global  omnidirectional 
sea-bias  uncertainty  of  3.5  knots  per  axis  was  used  for  Doppler  over-water  error  modeling. 

The  B-1  Offensive  Systems  display  panel  contains  a land/sea  switch  for  Doppler  over- land  or  over.water 
operation.  From  a filter-implementation  standpoint,  the  switch  controls  Doppler  covariance  matrix,  dynamics 
matrix  (corrclatlori  time),  process-noise  (compensation)  matrix,  and  state  vector  re-lnitlaltzatloos  and 
resets  for  transition  fi-c>a  land  to  sea  and  sea  to  land.  The  off-diagonal  covariance  elements  In  the  Doppler 
scale-factor  and  drift-angle  rows  and  colunns  are  set  to  zero  at  transitions.  For  flight  over  water,  tna 
Doppler  scale-factor  and  drift-angle  variances  are  reset  to  values  corasensurate  with  the  3.5  knot  sea-bias 
uncertainty,  while  the  acciarulsted  estimates  of  scale-factor  and  drift-angle  errors  are  retained.  At  land- 
fall the  scale-factor  and  d.lft-angle  variances  are  reset  to  their  Initial  (original)  over-land  values, 
while  the  accumulated  scale- factor  and  drift-angle  error  estimates  , which  have  presimiably  been  corrupted 
by  sea-surface  effects,  are  reset  to  their  (stored)  pre-over-watcr  values. 

The  process-noise  (Q)  matrix  Is  reset  concurrently  with  the  covariance  matrix  to  new  Markov-process 
equilibrium  values.  Process-noise  matrix  reset  alone  will,  of  course,  stimulate  the  same  Increase  (or 
decrease)  In  Ooppler-error-estimate  uncertainty  - but  over  a longer  period  of  tin*.  Resetting  both  the 
covariance  matrix  and  the  noise  matrix  at  land/sea  or  sea/land  transition  tells  the  filter  linnedlately  that 
the  Doppler  inrormatlon  Is  less  trustworthy  over  water  or  reliai’e  when  the  aircraft  Is  again  over  land. 

This  Is  particularly  Important  for  weapon  delivery,  since  It  results  In  markedly  lower  post-landfall 
velocity  errors.  The  measurnement-nolse  (R)  niatrix  is  not  reset  at  transitions  under  the  assumption  that 
Doppler  fluctuation  noise  Is  relatively  Independent  of  terrain. 

Figure  16  displays  relative  over-water  growth  rates  tor  ihree  operational  situations  (mission  scenario 
Similar  to  the  one  In  Fig.  3): 

(1)  Doppler  off  over  waber 
2)  Filter  reset  ever  water  (sea  setting) 

(3)  No  filter  reset  over  water  (land  setting) 

The  performance  predictions  were  obtained  from  the  suboptlmal  covariance  analysis  program  with  an  initial 
3.5  knots  per  axis  sea-bias  uncertainty  modeled  In  the  real  world.  The  figure  shows  that  the  performance 
degradation  Is  significant  when  Doppler  errors  in  the  filter  are  not  re-lnitiallzed  for  flight  over  water. 

The  figure  also  shows  that  the  large  Q values  In  the  filter  for  reset  over  water  Inhibit  heavy  Doppler- 
veloclty  damping. 

4.  3 Gyrocompass/Autocallbratlon  Filter 

As  discussed  In  Section  2,  long-range  over-water  cruise  navigation  with  no  position  fixing  plates  a 
premliin  on  periodic  Inertial  measurement  unit  autocalibration  and  on  gyro-calibration  stability.  To 
maximize  the  Interval  between  autocalibrations,  a two-position  ground  alignment  - or  gyrocompass  - 
mechanization  was  originally  Implemented  for  the  B-1.  The  Idea  here  was  that  operational  ground  align- 
ments would  then  provide  level-gyro  re-calibrations. 

The  B-1  ground  alignment  and  autocall bratl on  mechanization  Is  designed  around  a Kalman  filter  which  uses 
velocity  as  an  observable.  The  original  mechanization  consisted  of  seven  and  one-half  minutes  of  fine 
leveling,  azimuth  estimation,  and  north-gyro  calibration  in  the  first  position;  a 90  degree  slew;  and 
eight  minutes  of  azimuth  refinement  and  (original)  east-gyro  calibration  In  the  second  position.  The 
filter  is  "on"  during  slew.  For  the  sake  of  s''ftwars  commonality,  the  gyrocompass  filter  Is  structurally 
Identical  to  the  navigation  filter,  except  tha'  (in  accordance  with  the  dlsmssicwi  fn  Section  3.3)  there 
are  two  Icvel-accelerometer  bias-error  states.  Since  Ooppler-error  states  are  redundant  on  the  ground, 
the  accelerometer  bias  errors  are  modeled  In  place  of  the  Doppler  errors,  thereby  preservlTig  filter 
dimensionality.  The  accelerometer  states  are  replaced  by  Doppler  states  at  transition  from  the  ground- 
alignment  mode  to  the  navigation  mode.  Also,  for  the  sake  of  software  comnonall ty , the  B-1  gyrocompass 
filter  IS  a subset  of  the  B-1  autocalibration  filter;  that  Is,  autocalibration  Is  simply  extended  gyro- 
canpass.  About  2 hours  are  required  for  autocalibration  in  order  to  ach'eve  acceptable  azimuth-gyro 
Cdlibratlofi  accuracy.  Figure  17  displays  the  g/rocompass/autooallbration  error-dynami cs  equations  as  they 
are  currently  Implemented.  The  critical  terms  In  these  equations  relative  to  slew- Induced  accelercxneter- 
blas  observability  are  and  in  iiie  and  equations,  respectively. 

During  the  verification  piiase  of  gyroccxnpass/autocallbratlon  filter  development,  a single-position  gyro- 
compass was  Implemented  In  order  to  Increase  gyro-calibration  time  in  the  first  position  during  autocal. 

This  decision  was  also  based  on  an  analysis  of  the  anomalies  discussed  In  Section  5.2  and  on  accumulating 
evidence  to  the  effect  that  "1n-the-f1eld"  LN-15  gyro-calibration  stability  Is  much  better  than  had  been 
anticipated. 

4.4  Software  Considerations 
4.4.1  Transition  Matrix  Generation 
First-Order  Algorithm 

T.ie  problem  of  choosing  an  algorithm  for  transition  matrix  generation  arose  quite  early  In  the  B-1  navigation 
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filter  software-development  process.  An  analysis  of  algorlttir..  accuracy  requirements,  similar  to  that 
described  In  [1]  resulted  in  the  selection  of 

ro 

♦ (mat)-  II  (I  ♦ F.  at).  (22) 

k-1  ^ 

where  at  is  set  equal  to  1 second  and  ni  u 6,  the  number  of  seconds  In  t’le  6-1  Kalran  update  cycle.  Set- 
ting at  equal  to  1 second  eliminates  a multiplication. 

ftial  Filter  Consnonalltv 

There  are  two  navigation  filters  In  the  B-1,  one  for  each  Inertial  platform.  The  filters  operate  Indepen- 
dently of  each  other,  except  for  the  fact  that  they  use  the  same  Doppler-velocity  and  position-fix  update 
Information.  The  coarse- alignment  mechanlaatlon  ensures  that  the  wander  angles  of  the  two  platforms  are 
app-oximately  equal  at  the  Initiation  of  fine  alignment  with  the  Kalman  filters.  Since  both  platforms  will 
Indicate  approximately  the  satue  level-axis  velocity  components  for  parallel  alignment,  the  two  filters  use 
a coMRon  transition  matrix  for  error  propagation. 

A. 4.2  Design  Simplifications 

Airborne  computer  capacity  eventually  becoires  a limiting  design  factor  on  any  software- development  program. 
The  B-1  Is  no  exception  and  navigation  filter  design  slmpll  ■'! cations  have  been  Introduced  to  save  software. 
The  resulting  performance  degradation  Is  negligible  for  a typical  mission. 

Vertical-Channel  Decoupling 


The  dynamics-matrix  elements  In  Fig.  8,  which  couple  the  level  and  vertical-channel  errors,  have  been  set 
to  zero  In  the  current  B-1  filter  design,  and  the  level  and  vertlcal-cnannel  filters  opcinte  Independently 
of  each  other.  Since  the  vert  leal -channel  error  equations  are  Independent  of  aircreft  dynamics,  the  Kalman 
gains  become  constant  In  tute  after  an  initial  transient  period 

Prefilter  Aorroxiir.atl ons 

The  Doppler  prefilter  In  the  B-1  consists  of  simple  velocity  observation  averaging.  The  predicted  velocity- 
measurement  errors  ar-e  not  averaged.  As  a result,  tlie  velocity  residuals  are  of  the  form 

y - H«x* 

where  y • ^ t >1^  (n  - number  of  measuronents ) 

and  H4x'  is  evaluated  at  the  end  of  measurement  Interval.  The  6-second  Kalman  update  cycle  used  on 
the  B-1,  together  with  the  fact  th,i  Ooprler  updates  are  Inhibited  during  severe  lateral  maneuvers  (Mrge 
bank  angles),  makes  this  a workable  approximation. 

4.4.3  Heasur^ement  Matrix  Impleinoiitatlon 

The  software  code  and  timing  requirements  for  implementing  either  measurement  matrix  In  Fig.  9 are  similar. 
However,  the  matrix  which  utilizes  Yy  and  Yy  , rather  than  Yy  and  Y^,  .is  velocity  observables  has  been 
Implemented  In  the  B-1  navigation  filter  In  order  to  avoid  a square-root  canputatlon  for  groundspoed  and 
an  arc-tangent  computation  for  drift  angle.  These  computations  are 

V - [V  ^ V 
g X y •' 

i - tan'*  (-  -y^)  - Oj  , (23) 

where  Vj,  and  V are  system  velociry  components  and  is  me  platform  yaw-synchro  angle.  The  disadvantage 
of  using  Yy  ahd  Yy  as  velocity  observables  in  the  Kalman  filter  Is  that  it  constrains  the  designer  to 
model  equal  greundSpeed  and  drift-angle  measurement  noises  In  the  filter  R matrix  when.  In  fact,  these 
noises  a.-e  not  equal  for  all  Dopplers. 

5 . Flight-Test  Vci  i ficatlon 

Frcm  June  1974  through  August  1975,  a B-1  navigation  system  flight-test  program  was  conducted  at  Holloman 
Air  Force  Base  (New  Mexico)  aboard  a modified  C-141  Starllftcr  Aircraft.  Some  of  the  objectives  and  goals 
for  this  flight  test  program  were  [7]: 

(1)  lo  verify  navigation  hardware/software  compatibility  In  a realistic  dynamic  environment- 

(2)  To  Identify  navigation  hardware,  software  and  mechanization  equation  problems  at  an  early  point  in  the 
B-1  developnen-  schedule. 

The  avionics  software  on  board  the  aircraft  contained  tne  B-1  navigation  filter.  Although  the  avionics 
hardware  Included  an  Inertial  platform  anJ  Doppler  radar,  it  did  not  Include  a forward-looking  radar.  In- 
stead, aircraft  posltloo  rieasureTeots  were  perfottiKd  with  tlie  aircraft's  optical  vievffir.der  by  overflying 
checkpoints . 

The  navigation  flight-test  sequence  at  Holloman  proceeded  from  ground  tests  of  the  gyrocompass/autocallbrat.lon 
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mchanlzitlon  through  frc«>1n«rt<a1  fUght  tests  with  ground-all gmaent  or  autocallbratlon  Initialization 
to  Doppler-Inertial  flights  with  toth  ground  and  In-air  Inertial  ptatfona  allgiMent.  The  priaiary  objective 
of  tha  final  phase  of  Holloaan  flight  testing  was  to  verify  the  feasibility  of  using  fixed-antenna  Ocppicr 
hardware  with  Stahl  11  zed- antenna  Doppler  software.  Fro*  the  standpoint  of  filter  design  verification,  the 
Holloman  Program; 

(1)  Provided  range-calibrated  Doppler  perfamance  data  for  error  «odel  refinement. 

(2)  Exhibited  some  imexperted  'nertial  platform  slew-induced  phenomena  during  the  initial  phase:  of 
graund-alignnwnt  cneckout. 

5-1  Real-Norld  Doppler  Errors 

The  Holloman  flight-test  program  provided  a unique  opportunity  to  compare  the  performance  of  three  Uoppler 
radars  under  identical  operating  conditions  (same  terrain,  altitude,  and  speed)  and  relative  to  the  same 
velocity  reference.  The  three  flopplers  aie  the  APN-185,  the  APN-200,  and  the  APN-206.  Two  of  the  Dopplers 
(APN-200  and  ATN-206)  are  fixed-antenna  designs;  the  third  (APN-ISS)  utilizes  an  electteawchanically 
stabilized  antenna.  Tha  APN-IRS  and  APN-200  are  made  in  the  United  States;  the  APN-206  Is  made  In  Great 
Britain.  The  velocity  reference  was  CIRIS  (Coiapletely  Integrated  Reference  lnstrua«ntat1on  System). 

5.1.1  Second-Order  Markov-Process  Approximation 

Aui-ocorrel atlon  Function 

Groundspeed  and  drift-angle  outputs  from  all  three  Dopplers,  when  differenced  with  the  CIRIS  data,  exhibited 
similar  autocorrelation  properties.  Figure  18  is  a typical  groundspeed-error  autocorrelation  function. 

The  salient  characteristics  of  this  autocorrelation  function  are  a very  rapid  exponential  decay  (essentially 
a white-noise  component)  and  the  presence  of  non-decaying  oscillations  (periodic  componert).  The  periodic 
component,  which  appears  to  be  a sun  of  oscillatory  random  variables,  is  the  critical  data  conponent  in 
Fig.  18.  However,  as  cf  this  writing,  there  is  some  uncertainty  as  to  precisely  how  mjch  of  the  period- 
icity in  this  figui-e  is  due  to  Inherent  Doppler  errors  and  how  much  Is  attributable  to  reference  data 
handling. 

Reference  [8]  (preliminary  version)  states  that  a sun  of  autocorrelation  functions  of  the  form 

♦()(t)  - E [xj  (t)  Xj  (t+t)]  • *jj(0)  CJS  6 M (24) 


results  1r.  a reascfisble  analytical  approximation  to  the  periodic  component  in  Fig.  18.  This  reference 
also  suggests  that  a basic  model  which  represents  this  type  of  autocorrelation  function  is  the  second-order 
Hariov  process 

r.n  r irirn 
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(25) 


where  e is  a frequency  parameter  and  tha  damping  parsneter  has  been  set  to  zero, 
for  this  equation  is 


cos  bt 
-6  sin  fit 


“ sin  et 
cos  6t 


The  transition  matrix 
(26) 


With  Q - 0 and  ?(0) 


Pll(O)  0 

0 oj’ 

?1,  (t)  . 


the  covariance  Pjj  of  Xj  osclallates  In  time  as 

2 P.i  (0) 

Pjj  (0)  cos  et  • —=-5 [1  ♦ cos  2 Bt], 


(27) 


It  can  be  shown  that  the  autocorrelation  function 


<f  (t+  I,t)  - ♦ (t*  T,t)  P (t) 


si  ves ; 


♦ j j (I  ♦ T ,t) 


•'ll 


(0)  [cos  8 X cos 


2 


et  - sin  8 X sin  Bt  cos  Bt] 


(28) 


- Pjj  (0)  tOS  Bt  CO?  „ (t ♦ x) 


The  amplitude  of  P..  (0)  and  the  oscillation  frequency  0 can  be  selected  from  the  flight  data,  in  general, 
matching  the  autocorrelation  data  to  an  analytical  expression  like  the  one  above  requires  additional 
Independent  periodic  random  variables  - some  with  non-zero  Q's  and  non-zero  damping  coefficients. 

Truth  Model 


The  autocorrelation  function  In  Fig.  18  does  not  exhibit  the  Doppler  (tlim.- independent)  bias  erroi-s  which 
were  measured  during  the  Doppler  comparison  study.  These  errors  can  be  significant  for  Dopplers  which 
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not  b«en  cillbrateO  «t  the  nivigetlon-systea  level.  Hence,  the  data  aeeeted  to  show  that  the 
roiiklnatlon  of  randoei  constant,  uncorrelated  noise  end  second-order  Nariov  process  errors  May  be  a better 
truth  e»de1  (If  the  periodic  coaponent  Is  really  Inherent  to  the  Doppler)  than  the  one  assuaed  In  Fig.  10, 
which  consists  of  randoa  constant,  uncorrclated  notse.  and  first-order  Markov-process  errors. 


The  Inpllcatlon  of  these  results  for  Kalnan  filter  design  is  that  the  random  walk  (xq  = u)  Is  superior  to 
erponenti ally- correlated  noise  for  Kalnan  filter  Doppler  Models.  In  'act,  the  Doppler  model  In  the  B-1 
navigation  filter  at  HolloMan  was  converted  from  exponentially-correlated  noise  to  the  random  walk  as 
flight  tasting  progressed.  (A  practical  disadvantage  of  using  the  randon  walk  to  nodel  Doppler  errors  In 
a KaiMn  filter  is  that  its  variance  gr<»rs  without  bound  in  tltie  In  the  absence  of  updates.  Hence,  In 
lepinanting  this  error  eodel.  It  Is  dcsIraMe  to  Inhibit  process-noise  addition  when  the  error  variance 
has  reached  a pre-detenilned  Unit.)  Hntever,  the  Hollanan  results  as  a whole  seemed  to  Indicate  that 
either  Model  Is  sulcdble  for  airborne  filter  taplenentatlons . figum  19  snoivs  this  rather  dramatically 
for  a flight  whare  the  Doppler  node!  In  the  filter  was  exponentially-correlated  noise.  The  heavy  line  In 
the  figure  represents  the  sum  of  Doppler  scale- factor  error  estimates  rovided  by  the  filter  as  a function 
Of  time  for  one  of  the  Holloman  flights.  The  light  line  In  the  background  Is  the  true  velocity  scalefactor 
error  obtained  by  dlfftrenclng  CIRIS-derIved  groundspeed  with  Doopler-lndlcated  groundspeed,  dividing  by 
groundspeed  and  averaging  over  the  6-second  update  Interval.  The  Jagged  nature  of  the  averages  reflects 
the  relatively  noisy  output  of  a typical  Doppler.  The  superposition  of  the  true  and  estimated  scale- 
factor  arrors  shows  that  the  filter  Is  doing  Its  Job. 


5.1.2  Over-Water  Bias 


The  assimptlons  below  (see  Section  4.2.2)  were  basic  to  6-1  navigation  filter  design  for  Doppler-Inertial 
flight  ovarwater. 

(1)  Doppler  groundspeed  and  drift-angle  accuracy  is  dvgraded  due  to  sca-surface  motion. 

(2)  Doppler  measurement  (fluctuation)  noise  Is  essentially  1 ' “ependent  cf  terrain. 


The  upper  part  of  Fig.  20  shows  Doppler  groundspeed  errors  over  land  and  over  water;  the  lower  part  of 
the  figure  shows  the  associated  neasureaent-noise  standard  .ievlatlon.  The  data  Is  taken  from  a Holloman 
flight  which  "race- tracked"  over  the  Pacific  Ocean  off  the  California  Coast.  The  average  groundspeed  error 
was  obtained  by  differencing  Doppler-measured  groundspeed  with  Cl  Rif- derived  groundspeed  and  averaging 
over  6-second  (kalnan  update)  Intervals.  The  groundspeed  standard  deviation  Is  the  empirical  disper-slon 
of  the  sample  groundspeed  errors  about  the  average  error.  The  data  Is  displayed  In  three  segments:  the 
segoaent  to  the  left  Is  representative  of  groundspeed  accuracy  over  land  (calibrated  D&ppler);  the  segment 
In  the  middle  typifies  groundspeed  accuracy  over  water;  the  segment  to  the  right  Includes  a sea/lano 
transl tion. 


The  figure  clearly  shows  the  effect  cf  tea  current;  In  fclasin;  the  greundspeed  output.  (The  flight  sath 
Is  parallel  to  ttte  current.  Note  that  the  sea-bias  changes  polanty  when  the  aircraft  executes  a 180- 
degi-ee  turn.)  The  figure  also  shows  that  the  Doppler  ineasurement  noise  Is  only  slightly  larger  over  water 
than  It  Is  over  land.  Both  of  these  results  are  consistent  with  the  tllter  design  assuiptlons. 


5 . 2 (iyroconpass/Autocallbratlon  AnomaMes 


Djring  the  letter  stages  of  6-1  Offensive  Software  development,  the  two-position  gyi ocompass/autocal Ibra- 
tlon  filter  was  subjected  to  exhaustive  verification  with  the  simulation  program.  The  solid  11r.es  In 
Figs.  21,  22,  and  23  are  simulation  program  plots  of  expected  gyro-cal  1 brail  on  and  wander-angle  estimation 
erron  over  a 40-minute  time  Interval.  The  data  in  these  figures  represent  computed  standard  deviations 
for  a five-case  Monte  Carlo  randonr  sample  of  Inertial-sensor  and  iriltlallzatlon  errors.  In  the  first 
position  the  north  gyro  Is  calibrc’.ed  and  the  wander  angle  Is  estimated  to  an  accuracy  commensurate 
with  east-gyro  calibration  uncertainty.  In  the  second  position  the  (original)  east  gyro  is  calibrated  and 
the  wander- angle  estimate  Is  t-efined. 


Ihe  real-worU  results  were  not  always  this  pretty.  Figure  24  Is  a real  system  analog  of  the  slnulated 
results  In  Fl^s.  21  and  22  and  Is  typical  of  many  gyrocompass, 'autocalibration  checkout  runs  at  Holloman. 
(The  error  curves  In  Fig.  24  are  plotted  so  that  the  gyro  which  Is  pointed  north  in  the  first  position 
hii  zero  calibration  error  prior  to  slew  and  the  gyro  which  Is  pointed  north  In  the  second  position  has 
zero  calibration  error  after  a 30-minute  time  Interval.)  The  post-slew  gyro-calibration  overshoots  and 
offsets  were  coeeiletely  unexpected.  Moreover,  the  magnitude  of  the  filter's  gyro-calibration  estimates 
varied  frnm  nw>  to  run  and  appeared  to  be  a function  of  the  wander  angle  used  to  Initialize  the  system. 
As  a final  surprise,  the  accelerometer  biases  estimated  by  the  f1  Iter'durlng  real-platform  slew  differed 
appreciably  from  accelerometer  biases  measured  during  IMU  acceptance  test  procedures  (ATP). 

Analytical  Investigations  of  these  phenomena  focused  seguentially  on  the  following  candidate  causes: 

(1)  Level-gyro  scale-factor  calibration  Inaccuracy. 

(2)  Vertlcai-gyro  torquer-axls  misalignment. 

(3)  Yaw-Synchro  noise  during  platform  slew. 


Analysls  of  long-term  level-gyro  scale-factor  calibration  date  revealed  stability  to  within  0.01  percent  - 
less  than  .0015  degree  per  hour  of  equivalent  gyro  drift  a*.  Holloman  latitudes.  Consequently  level-gyro 
scale-factor  calibration  Inaccuracy  did  not  appear  to  be  the  problem. 

5.2.1  Ve»  tlcal-pyro  Tor*iuei~-Axls  Misalionnent 

Consider  the  error  equations 

• -I  fy  " 
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♦x  " “z  (♦y  ^ ''x'  ^ 'x  ^29) 

♦y  ■ “z  ^-♦x  * ^ ‘y 

for  a stationary  inertial  measurement  unit.  The  symbols  and  n„  In  these  equations  are  vert1cal-gyro 
torquer-axis  misalignment-angle  components  along  the  platform  level  axes.  Be^re  platform  slew 
(on  the  order  of  10  degrees  per  hour)  and  the  filter  cannot  distinguish  between  platform  tilt  and 
accelerometer  bias.  During  platform  slew  uj  ■ (about  1000  degrees  per  hour)  and  the  equations  show 
that  the  platform  will  be  tilted  until  the  z-gyro  torquer-axis  Is  vertical.  The  tilt  Is  accomplished 
through  accelerometer^bl as- correction  buildup  - the  filter.  In  effect,  adding  vertical-gyro  misalignments 
to  accelerometer-bias  estimates.  Although  vertical-gyro  torquer-axis  misalignment  helped  explain  the 
difference  between  ATP-measurcd  and  filter-estimated  accelerometer  biases,  simulation  studies  showed  that 
this  error  source  did  not  stimulate  the  post-slew  gyro- calibration  overshoots  and  offsets. 


5.2.2  Yaw-Synchro  Noise  during  Platform  Slew 

One  advantage  (at  least  for  analysts)  of  a local-level  wander-azimuth  mechanization  which  utilizes  vertical 
earth-rate  torquing  is  that  Inertial  platform  heading  Is  constant  during  ground  alignment  and  autocalibra- 
tion. In  the  B-1  mechanization  the  on-board  computer's  estimate  of  platform  heading  or  wander  angle  Is 
used  In  the  equations 


« fi  cos  cos 


’ -fi  sin  cos  x^ 


(30) 


to  resolve  earth  rate  along  the  platform  x and  y axes  for  level-gyro  torquing.  In  Eq.  (30 ) n 1s  earth  rate, 
X Is  Input  latitude,  and  Is  current  wander  angle.  During  platform  slew  the  wander  angle  Is  updated 
with  the  equation 

“1  " “1-1  ■ *^®z^  ^®s  ^31) 

where  Is  the  wander-angle  error  estimate  from  the  filter  (zero  longitude  error  In  Eqs.  (14)  ) and  ao^ 
is  an  Increment  In  the  yaw-synchro- angle  readout.  A new  wander-angle-error  estimate  Is  available  from  the 
filter  every  6 seconds  - with  or  without  slew,  the  AO^  Increments  are  available  every  1/16  of  a second. 

The  solid  lines  in  Figs.  21,  22,  and  23  were  taken  froma simulation  run  with  an  error-free  synchro  angle. 
However,  when  yaw-synchro  noise  was  added  to  the  simulation  during  slew,  the  overshoots  and  offsets  appeared. 
The  dotted  lines  in  Figs.  21,  22  and  25  are  taken  from  a simulation  run  which  is  identical  to  the  one  which 
generated  the  solid  lines,  except  that  uncorrelated  noise  was  added  to  the  simulated  yaw-synchro  readout. 

The  reason  why  the  offsets  appear  is  that  yaw-synchro  noise  results  in  post-slew  wander-angle  errors  of 
which  the  filter  is  unaware,  and  the  filter  assigns  this  error  to  gyro  drift.  Laboratory  evaluations  have 
confirmed  the  presence  of  readout  noise  in  even  the  best  IMU  gimbal-angle  synchros.  Hence,  the  cumulative 
effects  of  yaw-synchro  noise  (or  an  equivalent  yaw-synchro  bias  shift  during  platform  slew)  turned  out  to 
be  the  cause  of  the  gyro-calibration  anomalies  observed  at  Holloman. 

A filter  modification  which  eliminates  this  problem  Is  the  addition  of  process-noise  compensation  during 
slew  at  the  wander-angle-error  (c'o^)  level.  The  dashed  lines  in  Figs.  21,  22,  and  23  are  the  same  simula- 
tion run  once  more  with  additional  process-noise  compensation  during  slew.  The  anomalies  have  been  removed 
and  the  gyro-calibration  curves  are  almost  congruent  with  the  original  results.  The  compensation  increases 
the  ie  -estimate  uncertainty  at  the  end  of  slew  and  permits  the  filter  to  re-estimate  the  wander-angle 
error  prior  to  resuming  gyro  calibration.  As  a result  of  these  Investigations,  yaw-synchro  noise  compensa- 
tion was  added  to  the  B-1  gyrocompass/autocalibration  filter  mechanization. 

6.  Conclusions 


The  B-1  navigation  filter  is  a conservative,  straight-forward  design.  Although  Holloman  flight-test  verifi- 
cation produced  some  hartViare /software  Interaction  surprises,  design  refinements  resulted  in  filter  perfor- 
mance which  was  actually  better  than  had  been  anticipated.  The  principal  design  refinement  to  the  naviga- 
tion filter  was  Doppler  error  model  conversion  to  the  random  walk. 


in  retrospect,  the  Holloman  experience  associated  with  leaving  the  gyrocompass/autocalibration  filter  on 
during  inert' al  platform  slew  at  high  angular  rates  suggests  that  attendant  theoretical  advantages,  such 
as  accelerometer-bias  estimation,  may  be  minimized  by  real-system  phenomena,  such  as  vertical-gyro  torquer- 
axis  misalignment  and  yaw-synchro  readout  inaccuracies.  Since  the  primary  purpose  of  inertial-measurement- 
unit  autocalibration  is  gyro-drift  estimation  and  since  navigation  system  performance  In  the  Doppler- 
inert  al  node  Is  relatively  insensitive  to  accelerometer  bias  errors , it  would  probably  suffice,  in 

during  slew  (while  maintaining  software  coarse  leveling)  and  to  re- 
initialize the  niter  for  platform  re-alignment  and  gyro- cal ibrat ion  refinement  in  the  second  position. 
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SUHHARY 

This  lecture  describes  the  experiences  gained  at  the  DFVLR  Braunschweig  In 

- error  modeling  for  navigation  sensors 

- designing  iilters  for  hybrid  navigation  systems 

- sensitivity  analysis  of  these  filters 

- building  up  high  precision  reference  systems  for  the 
flight  tests 

- flight  testing  hybrid  navigation  systems  and 

- evaluating  the  flight  test  results. 

The  navigation  accuracies  of  Doppler-inertial  and  baro-inertial  systems,  derived 
from  theoretical  analysis  and  flight  tests,  are  given. 


1.  INTRODUCTION 

inertial  navigation  systems  (INS)  of  the  present  generation  attain  navigational 
accuracies  with  a positional  error  of  less  than  1 nautical  mile  after  1 hour  of  flight. 
These  errors  are,  in  general.  Increasing  with  time,  so  that  in  long- durat ion  flights  or 
In  missions  where  very  high  navigational  accuracy  is  required,  the  position  and  velocity 
accuracy  of  the  INS  a^one  is  not  sufficient  to  guarantee  mission  success.  In  these  cases, 
the  INS  is  aided  with  the  help  of  additional  navigation  sensors  such  as  Doppler  radar, 
pressure  altimeter,  etc. 

In  this  lecture  the  experiences  gained  at  the  Dl'VLR  Braunschweig  in  designing  and 
flight  testing  hybrid  navigation  systems  are  described.  As  examples,  the  conventional  and 
the  optimal  aiding  of  the  horizontal  channels  of  an  INS  with  a Doppler  radar,  and  of  the 
vertical  channel  with  a pressure  altimeter,  are  considered  in  detail. 


2.  FLIGHT-TEST  ARRANGEMENT  AND  REFERENCE  SYSTEM 


The  test  flights  are  carried  out  with  the  HFB  320  aircraft  of  the  DFVLR  (see  Figure 
1),  which  has  an  LN3  inertial  platform,  a Honeywell  H316  computer,  a magnetic  tape  for 
data  recording  (5  times  pe:  second)  (see  Figure  2),  a Doppler  radar,  a pressure  altimeter, 
and  different  radio-navigation  aids  on  boar.'. 

The  test  flights  are,  in  general,  carried  out  within  the  lock-in  range  of  one  or 
several  tracking  radars,  to  obtain  the  high  precision  required  for  the  position  and 
velocity  reference.  Figure  3 shows  a typical  flight  path  of  the  HFB  320  and  the  lock-in 
range  (some  7S  kilometers)  of  the  KPS  36  radar  equipment,  located  in  Meppen,  Germany.  The 
corresponding  velocities  of  the  aircraft  are  shown  in  Figure  4,  and  the  horizontal  accel- 
erations are  shown  in  Figure  5.  (The  accelerations,  velocities,  and  flight  path  have  been 
measured  by  the  unaided  INS.) 


The  high-precision  velocity  and  position  m.eas  ur  em,en  t s are  obtained  by  off-line 
smoothing  of  the  data  obtained  from  the  tracking  radar  with  the  help  of  the  INS.  The  most 
appropriate  form  of  the  smoother,  for  the  purpose  of  evaluating  this  data,  is  the  optimal- 
smoothing  algorithm  developed  by  Rauch,  Tung,  and  Striebel  [11,  which  consists  of  a K.alman 
forward  and  backward  filter. 


The  ti'  .a-discrete  model  equations  of  t..e  system  to  be  smoothed  are 


x(k)  ; ♦(k,k-l)  x(k-l)  e u(k-l) 
y(  k ) = H(  V ) x(  k ) ♦ v(  k ) 


ere 


♦ ( k . k - 1 ) , H ( k ) 
y ( k I 
■.IV),  V ( k ) 


transition  and  measurement  matrices 
state  and  measurement  vectors 

uncorrelated  noise  vectors  with  covariance 
matrices  Kk)  and  P(k). 
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Tha  Kalaan-forward-ftltar  aquatlona  of  tha  Rauoh/Tung/Strlabal  algorithm  era 

SUk)'  a ♦(k,k-l)»{k-l)'^ 

8(k)*  * ft(k)"  ♦ K(k)  (y(k)  - H(k)ft(k)") 

P(k)’  a ♦(k,k-l)P(k-l)**(k,k-l)’  ♦ Q(k-l) 

K(k)  a P(k)'H(k)’^(H(k)P(k)’H(k)'^  tR(k))"^ 

P(k)*  a (I  - K(k)H(k))P(k)’^ 

Nhara 

P(k)  , P(k)^  = cova.'ianca  matrlcaa  of  (x(k)  - x(k))  and 

(x(k)^  - x(k)) 

lt(k)  , St(k)^  a filtered  aatlmatea  of  x(k)  Immediately  before 
and  after  measurement  k 

K(k)  a optimal  gain  of  forward  filter. 

The  backward-filter  equations  of  the  Rauch/Tung/Strlebel  algorithm  are 


x(k ,N  ) = x( k )^ 

+ C(k) 

(x(k+l,  N)  - *(k+l. 

k)x(k)^) 

C(k)  = P(k)^ 

*(k+l. 

k)’'^  (P(k  + 1)')"^ 

(3) 

P(k,K)  = P(k)^ 

+ C(k) 

(P(k+1,  N)  - P(ktl)‘ 

)C(k)'^ 

and  are  started  with 

x(M,N)  a x(N)"^ 

P(N,N)  a P(N)'^ 

where 

N a total  number  of  measurements 

x(k,N)  a smoothed  estimate 

P(k,N)  a error-covariance  matrix  of  smoothed  estimate 
C(k)  a optimal  gain  of  backward  filter 

The  error  aodel  of  the  INS,  which  is  described  in  Section  3.1,  was  combined  with 
ar.  uncorrelate d-ao i se- type  error  of  the  radar  measurement  to  obtain  the  reference-system 
error  model.  The  result  of  a sensitivity  analysis  (see  Section  u.l)  of  the  velocity  error 
of  the  forward  filter  is  presented  in  Figure  6,  showing  a good  correspondence  between  the 
actual  error  and  the  forward  filter's  self-diagnosis.  This  means  that  the  filter  is  rather 
insensitive  to  the  model  simplifications  described  in  Section  3.1.  The  precision  of  the 
reference  position  is  illustrated  in  Figure  7 (filtered  estimate)  and  Figure  0 (smoothed 
estimate).  These  figures  show  the  high  accuracy  of  the  reference  system,  in  that  position 
errors  are  on  the  order  of  10  meters  and  velocity  errors  are  on  the  ordor  of  less  than 
0.1  meter  per  second.  This  accuracy  is  also  obtained  in  flight  periods  where  the  radar 
has  lost  the  target  for  several  minutes  [2]  . 


3.  ERROR  MObELS  OF  THE  SENSORS 
3.1  Inertial  Platform 

The  test  airorait,  HFB  320,  has  an  LN3  inertial  platform  on  board.  Figure  9 shows 
the  position  error;:  of  the  horizontal  channels  during  a laboratory  test  run  of  the  un- 
callbrated  EN3.  Figure  10  shows  the  corresponding  acceleration  and  velocity  errors:  large 
Schuler  as  wall  j 24-hours  ->s  c i 1 lat  ions  are  excited  by  the  bias  errors  of  the  uncali- 
brated gyros  and  accelerometers.  Theoretical  analysis  [3]  and  evaluation  of  laboratory 
tests  (see  Figur--,  9 and  10)  lead  to  the  error  model  for  the  LN3  given  in  equation  (4), 
The  elements  o!  •.r,e  state  vector,  x,  are: 

(1)  Tf.-ee  misalignment  angles,  o,  B,  T»  about  the  east,  north 
•1-  ; vertical  axes  (local-level  mechanization  of  the  INS). 

(2)  ' c,  r respond  i ng  velocity  errors,  dv^  , dv^,  dv^  , in  east, 
r jrth,  and  vertical  directions. 

( J)  1 -ition  errors,  dL,  dl  , dh  (latitude,  longitude,  and 
n-ight  errors). 

In  addition, 

r - distance  of  aircraft  from  earth  center 

-J  : earth  rate  (IS  dogrees/h) 

i.  ^latitude 
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h • height 

Vq,  V|^,  Vj  » aircraft  velocitiea 

An > A„ , A s accelarationa  measured  by  the  INS 
U N Z 

R.  s earth  radius 

® 2 
g = 9.81  m/a^ 

* ''y  ’ _ gyro  drift  rates  and  accelerometer  errors  in 

a , a , a * the  three  axes, 

X y 2 

Neglecting  the  Foucault  modulation,  the  coupling  of  the  24-hour  oscillation,  and 
the  acceleration  coefficients  given  in  equation  (4),  one  obtains  the  simplified  error 
model  of  the  LN3  shown  in  Figure  11.  With  these  simplifications,  the  horizontal  channels 
are  nearly  decoupled  from  each  other  and  have  a very  similar  error  behaviour.  The  insta- 
bility of  the  vertical  channel,  which  is  completely  decoupled  from  the  horizontal  channels 
in  this  simplified  model,  is  clearly  visible.  Figure  12  shows  the  position  errors  of  the 
north/south  channel  excited  by  several  typical  alignment  and  sensor  errors.  Figure  13 
illustrates  the  instability  of  the  vertical  channel.  For  most  applications,  the  simplified 
error  model  shown  in  Figure  11  is  sufficiently  accurate. 


3.2  Doppler  radar 

Figure  14  shows  a comparison  of  the  horizontal  aircraft  velocities  measured  by  the 
well-calibrated  and  aligned  LN3,  and  by  the  Doppler  radar  of  the  HFB  320:  the  correlation 
time  of  the  Doppler  radar  errors  is  on  the  order  of  a few  seconds,  so  that  the  assumption 
of  an  uncorreiatsd  Doppler  e-.-ror  is  justified  for  the  sampling  interval  of  10  seconds, 
w(i‘ ch  has  been  chosen  for  the  Doppler  aiding  of  the  INS. 


3.3  Pressure  altimeter 

Assum.ng  a known  distribution  of  air  temperature  with  height,  the  barometric  height 
can  be  calculated  directly  from  the  measured  static  pressure,  p.  The  best  known  relation 
between  height  and  pressure  is  the  barometric-height  formula 

HB  = - 8000  • In  <P/Pg)  tml  • (5) 

p is  the  static  pressure  at  sea  level  which  must  be  known  for  the  determination  of  the 
barometric  height.  The  relation  given  in  Eq.  (5>  is,  however,  not  sufficiently  accuratg 
for  practical  purposes,  as  it  rests  on  the  assumption  of  a constant  air  temperature  (0  C). 
A number  of  "standard  atmospheres"  have  been  used  at  various  times.  For  our  test  flight, 
the  formula  used  to  calculate  the  height  from  the  pressure  was 

3 2 

HB  = 1^3?  * 3jP  + 3j^p  + a^)  + D . (6) 

a^ , a , a and  a^  are  coefficients  obtained  empirically.  The  parameter,  D,  is  determined 
before  the  start;  so  that  at  the  measured  static  pressure,  HB  is  the  correct  height  at 
the  start. 

The  deviations  of  the  real  from  the  standard  atmosphere  are  due  to  the  weather.  As 
an  example.  Figure  15  shows  the  altitude  variations  with  time  of  three  pressure  levels 
measured  at  Hannover  airport.  To  determine  the  influence  of  the  weather  on  the  barometric 
measurement  in  an  analysis  of  errors,  we  shall  start  from  the  following  representation  of 
the  atmosphere:  the  atmosphere  does  not  change  during  the  test  flight  time  ( 1 to  2 hours). 
In  the  range  of  the  test  flight  (some  100  kilometers  around  the  place  of  start),  the  in- 
clination of  the  isobaric  surface  planes  to  the  horizontal  remains  the  same.  The  height 
error  at  the  place  of  start  is  a linear  function  of  the  heigJit.  These  assumptions  are 
certainly  not  very  rigorous,  but  they  present  a good  first  approximation  to  the  reality 
(the  model  can  easily  be  made  more  accurate  by  assuming  second  order  terms  and  a time 
deper.dence , this  however  requires  more  computation).  If  an  aircraft  flies  with  east,  north, 
and  vertical  velocities,  v , v and  v through  this  static  atmosphere,  then  the  barometric 
height  shall  be  wrongly  measured  by  the  amount  AHBj. 

^ (AMB^)  = e^Vp  t c„v^  t . (7) 

c and  Cjj  are  the  inclinations  of  the  pressure  surfaces  [m/m] , and  c_  is  the  proportion- 
ality factor  [m/m]  between  the  height  error  at  the  place  of  start  and  the  height. 

The  extreme  values  for  t^,  c and  can  be  obtained  from  the  weather  charts 
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The  accuracy  with  which  the  static  pressure  can  be  measured  in  an  aircraft  depends 
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on  th«  plac*  in  which  tha  ••ntor  la  posltlonad.  Thla  error  haa  baan  naaaurad  for  tha  HTB 
320  with  which  wa  oartlad  out  our  taat  flight  and  la  ahown  in  flgura  16.  Tha  linaar 
approxiaation  haa  baeu  used  for  tha  oonaldaration  of  arrora. 


C|.  = -0.67  from  flgura  16  . 

c_  danotaa  tha  proportionality  factor  batwaan  tha  valoolty,  v,  and  the  error,  6HB,.  Tha 
ramaining  arrora  of  the  barometric  height  maaauramant,  which,  in  compariaon  to  the  two 
pravioualy  aantlonad  arrora  are  amall,  are  neglected  in  tha  error  analyala. 

The  complete  error  model  for  the  preaaure  altimeter  (aee  Eq.  (7)  and  (8))  la  pre- 
santad  in  Figure  17.  VR^  ia  an  additional  uncorralated  error. 


4.  HYBRID  NAVIGATION  SYSTEMS 

4.1  Kalman  filtering  and  aensltlvlty  analysis 

Figure  18  shows  a schematic  block  diagram  of  a hybrid  navigation  system  as  it  will 
be  considered  in  following  sections;  the  navigational  information  delivered  by  the  INS  is 
compared  with  an  additional  sensor,  such  as  a Doppler  radar,  or  a pressure  altimeter.  The 
difference  of  both,  the  "measurement”,  is  fed  into  a Kalman  filter  which  estimates  the 
errors  of  the  INS  and  the  additional  sensor.  These  errors  can  be  corrected  on-line  with 
the  help  of  a suitable  controller.  Our  experiences  have  shown  that  in  the  case  of  a time- 
discrete  estimator  with  10  second  sampling  period  the  controller  can  simply  be  a con- 
stant-feedback matrix  T *,  chosen  in  such  a way  that  the  estimated  errors  of  the  sensors 
are  driven  to  zero  in  the  sampling  period  after  the  measurement.  The  reason  for  thlt  is 
that  tha  low-frequency  error  behavior  of  the  INS  makes  the  estimation  process  slow,  so 
that  tha  non-optimal  controller  practically  does  not  influence  the  estimation  accuracy 
and  the  time  required  to  identify  the  errors. 

A major  problem  is  encountered  when  one  attempts  to  implement  these  techniques.  The 
model  for  an  exact  description  of  the  hybrid  system  may  either  be  too  complex  for  a com- 
puter of  reasonable  size,  or  the  model  ia  not  yet  known  exactly  to  the  design  engineer. 

For  example,  the  Statistical  parameters  characterizing  the  random  sensor  errors  (e.g., 
gyro  drift  rates)  are  rarely  known  exactly. 

The  solution  to  this  problem  can  be  to  design  a suboptimal  filter  of  smaller  size, 
one  that  represents  the  most  important  system  aspects  and  neglects  minor  effects  on  the 
navigation  accuracy.  The  suboptimal  filter  is  often  less  sensitive  to  inexact  implementa- 
tion of  parameters.  However,  in  any  case,  navigation  accuracy  is  lost  when  the  optimal 
filter  is  replaced  by  a suboptimal  one. 

The  actual  estimation  errors  for  a suboptimal  filter  cannot  be  calculated  by  solving 
the  Riccati  equation,  because  this  equation  is  based  on  the  assumption  that  there  is  no 
difference  between  the  model  used  in  the  filter  and  the  real  world.  A set  of  equations 
describing  the  actual  estimation  error  covariance  matrix  of  filtering  algorithms  in  the 
case  of  Inexact  modeling  has  been  given  by  R.E.  Griffin  and  A.P.  Sage  [4]. 

The  N-dimensional  error  model  of  the  hybrid  navigation  system,  containing  all  known 
error  sources  and  all  couplings,  and  representing  the  design  engineer's  best  knowledge  of 
the  system  errors,  is  called  "real  world"  in  the  following  sections,  and  is  described  by 

x=Fx+c+Gu  (N-dimensional  system) 
y = H X + V 

F,  G and  H are  constant  matrices;  and  u and  v are  white-noise  vectors,  uncorrelated  wi;h 
each  other.  The  vector  c represents  the  error-correction  inputs,  obtained  by  multiplying 
the  estimated  state  vector,  x,  with  the  control  matrix,  T*. 

The  measurement  vector  is  fed  into  the  suboptimal  Kalman  filter  of  dimension  M 
(MSN)  with  the  well-known  structure  described  by 

X = F*  X + c + K*  (y  - H*  x) 

K*  = F*  R*“^  ( 10 ) 

P*  : F*  P*  + P*  F*^  + G*  Q*  G*^  - P*  H*^  R*"^  H*  P* 


The  starred  matrices,  F* , G*,  and  H*,  are  the  system  matrices  of  the  H-dimensional  repre 
sentatlon  of  the  hybrid  system  errors  in  the  filter.  The  matrices  P* , Q*  and  R*  are 
defined  by 


t'* 

P * f,  ( t - T ) 

0*  T ) 


I,  (x*  x*”'^) 

F,  ( V*  ( t ) v*^  ( T ) ) 

f;  (u*  (t)  U*"^  (t)) 


4/ 


f *• 
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E (...)  s •xp«ct«<l  valu* 

6(t)  ~ delta  function 

X*  : error  In  the  estleate  (calculated  under  the 

aasunptlon  that  no  rilocrapancy  b«tw«eri  the  real 
world  and  the  model  syatee  exists) 

V*  and  u*  : white-noise  inputs  of  the  model  syote*. 

The  covariance  catrix,  P*  , of  the  estimation  error,  x* , may  be  regarded  as  giving  the 
self-dlagnoals  of  the  filter. 

Thla  eituation  la  illustrated  in  Plgure  19,  wtiich  shows  the  closed  loop  of  the 
hybrid  navigation  aystesi:  the  real-world  model  representing  the  sensor  errors,  the  Kalman 
filter,  based  on  the  simplified  error  model  of  these  sensors,  and  the  controller,  l~  *,  for 
the  correction  of  the  ectiSiated  errors. 


If  the  error  model  -jaed  in  tho  filter  is  incorrect  or  Incomplete,  the  actual  esti- 
mation-error covariance  matrix  la  no  longer  described  by  the  Rlccatl  equation  (sea  Eq. 
(10)).  A set  of  matrix  equations  describing  the  time  propagation  of  the  actual  eatlmation- 
arror  covariance  matrix.  P , the  couarlar.ee  matrix,  P , of  the  actual  state  vector,  and 
the  c ross - CO var 1 ance  matz-lx,  P , between  tho  actual  s^nte  and  the  error  in  the  estimate 
has  been  derived  in  [4]  for  discrete  filters.  These  equations  had  to  be  modified  to  in- 
clude the  effect  of  the  feedback  matrix,  T*.  The  following  continuous  set  of  matrix 
equations  is  obtained 

P = <r»  - K*H*)  P ♦ P (r*  - 

A a a 

♦ (ir-K*dH)  ♦ pj  (dr-K*AH)‘ 

t K*  P.K*^  t GQG^ 

P t r «P  t (Ft!'*)  F ♦ P (F»-K*H*)^  (11) 

c « T ^ 

+ p ( ar  - K*AH ) - qqg‘ 

X 

per  •p'^  t p r V (F  < r *)p 

X C C J X 

f P (F  t r ♦)  t GQO 

X 


p^  = E ((5  - x)  (5  - x)^) 

P^  e Z (X  (S  - x)"^) 

P^  = E (xx^) 

4F  r F*  - F 

AH  s H*  - H (E  is  the  expected  value) 


The  Bterrod  oiatrlces  refer  to  tho  model  system  which  is  the  basis  for  the  filter, 
and  the  unoterred  matrices  refer  to  the  real-world  system  describing  the  ectual  sensor 
errors.  If  the  model  state  vector,  x* , contains  fewer  elements  than  the  real-world  state 
vector,  X,  a linear  re  1st  lo.tshlp  must  exist  between  the  two  state  vectors 

x*  I Sx 


where  £ la  a nonsquare  matrix.  The  starred  e.atrlces  in  Eq . (11)  have  to  be  -ransfermed, 

to  be  ccopatlLie  in  terras  of  their  dimension  with  the  unstarred  mstrices,  for  example 

F*  - S^F»S 


for  a one - d 1 mans iona 1 real  world  and  a one -d i meno Iona  1 filter.  Eq.  (II)  can  ba  re- 
presertad  in  a block  diagram  aa  chowc  In  Figure  ?0 . The  block  (n  broken  lines  descrioes 
the  astiDotion  error  covariance  propagation  for  an  estimator  with  the  sane  atructure  as 
tr.e  Kalman  flltar,  bia  with  arbitrary  (not  optimal)  gaine,  K*. 

If  there  era  no  modeling  errors  ( AF  - AH  =0),  the  three  dynamic  systems  d»:.;riLir.g 
the  time  histories  of  P , P end  P are  only  coupled  by  the  f eedbtck -ma t ri  x , 7 *,  and  in 
open-loop  operation  the^  erJ  coirpl^ieJy  uncoupled.  If  AF  or-  AH  are  different  from  zero, 
the  covariance  of  the  actue)  state,  P , excites  tne  dynamic  system  which  deicribcs  the 
time  propagation  of  F , and  the  c rose - covari a nee , P , excites  the  dynamic  system  of  P , 
vie  Af  - R*  AH.  c c a 


Tha  coapu  i a t Iona  for  the  dcslTr.  of  the  novixation  filters  described  in  the  following 
• act  1 one  have  been  carried  out  with  the  1 1 me - d I sere t e verelons  of  Eq.  (10)  and  (11)  with 
a samp)e  interval  of  10  eeconde. 


■t.3  Kgritont«l  Channels 


4.3.1  Convantional  Doppler  INS 

The  oonventional  Doppler  aiding  of  the  INS  coneistB  of  feeding  the  differences  ba- 
tveen  the  INS  velocities  and  the  Doppler  velocities  back  into  the  INS  to  correct  the  plat- 
forn  att'tude  and  velocity. 


In-flight  levelinc 


Figure  21  shows  the  error  diagram  of  the  conventional  second-order  leveling  loop. 
The  Schuler  oscillations  are  damped  and  their  frequency  is  augmented:  the  leveling  loop 
is  N-tlaas  Schuler  tuned  and,  in  general,  critically  damped.  The  noise  content  of  the 
Doppler  velocity  measurements  is  also  fed  back  into  the  INS  and  causes  additional  errors, 
the  magnitude  of  which  depends  on  the  gain  constants  N and  k . 


In-flight 


Figure  22  shows  the  error  diagram  of  a third-order  gyrocompassing  loop.  In  addition 
to  the  leveling  loop  in  Figure  21,  the  difference  in  the  measured  north  velocity  is  also 
fed  back  to  the  vertical  gyro  torquer  to  correct  the  azimuth  misalignment  of  the  INS.  This 
third  order  loop  has  to  be  laid  out  in  such  a way  that  the  errors  in  the  INS,  caused  by 
the  Doppler  noise,  can  still  be  tolerated,  and  that  the  alignment  is  t ime-opt imal . 


4.2.2  Optimal  Doppler  INS 

A Kalman  filter  is  designed  on  the  basis  of  the  sensor-error  models,  described  in 
Sections  3.1  and  3.2.  For  the  implementation  in  the  on-board  computer,  the  error  model  of 
the  LN3  ( Eq.  (4)  ) is  simplified  corresponding  to  Figure  11.  Figure  23  shows  the  position 
error  computed  with  the  real-world  model  of  the  LN3  (Eq.  (4))  for  a 3-hour  flight  in  the 
north/south  channel  as  curve  @ . The  platform  ir,  aligned  to  20  arcseconds  (lo)  in  the 
level  axes  and  to  3 areminutes  ( lo ) in  the  azimuth.  The  gyro-drift  rates  are  0.01  degree 
per  hour  and  the  accelerometer  biases  are  10"**  g.  The  curve  @ in  Figure  23  shows  the 
position  error  of  the  filter  model  (Figure  11),  which  also  neglects  the  gyro-drift  rates 
and  the  accelerometer  biases.  In  this  model,  it  is  assumed  that  the  alignment  errors  are 
the  main  error  sources. 

To  make  the  filter  for  the  Doppler  INS  less  sensitive  to  the  model  simplifications, 
the  Doppler  noise  in  the  model  was  assumed  to  be  three  times  as  high  as  it  is  in  reality: 

3 meters  per  second  ( lo ) . No  process  noise  (gyro  or  accelerometer  noise)  was  assumed  in 
the  filter.  Figure  24  shows  the  actual  north/south  position  error  of  this  hybrid  system 
and  compares  it  with  the  filter's  self-diagnosis.  After  1 hour  the  actual  error  increases 
more  and  more  due  to  the  model  simplifications.  This  also  becomes  obvious  in  Figure  25, 
which  shows  the  corresponding  velocity  errors.  The  model  simplifications  also  cause  an 
increase  in  the  ve loci ty -est imat ion  error.  Curve  @ in  Figure  25  shows  the  steady-state 
error  of  a 20-times-Schuler-tuned  and  critically  damped  leveling  loop.  The  actual  error 
of  the  optimal  system  becomes  even  greater  than  the  error  of  the  conventional  mechanization 
after  2 hours  of  flight  time  with  this  filter.  The  effect  of  decreasing  the  sensibility 
of  this  filter  to  model  errors  is  illustrated  in  Figure  26:  Curves  (T)  , @ , and  (5)  of 
this  figure  .show  the  high  dynamics  of  the  gains  of  the  sensitive  filter.  The  addition  of 
an  artificial  process  noise  (gyro  and  accelerometer  noise)  makes  the  dynamics  disappear 
and  the  filter  less  sensitive  to  the  model  simplifications  (Curve  ® of  Figure  26).  The 
navigation  errors  obtained  with  this  insensitive  filter  are  illustrated  in  Figures  27  and 
28.  These  figures  show  a good  correspondence  between  the  filter's  sel f-diagr.os i s and  the 
actual  errors.  The  position  errors  of  few  hundred  meters  after  1 or  2 hours  of  flight  time 
have  been  well  confirmed  by  comparing  the  flight-test  results  to  the  measurements  of  the 
reference  system  described  in  Section  2. 


“.3  Vertical  channel 


w.3.1  Conventional  baro-INS 

The  conventional  aiding  of  the  vertical  channel  of  the  platform  is  shown  In  Figure 
23.  The  difference  between  the  I ne r t i a 1 h e i gh t , Hi,  and  the  barometric  height,  HD,  is  fed 
back  through  the  gain  factors,  and  Kj,  for  the  correction  of  the  vertical  velocity  and 
height.  The  factors  h.  and  Kj  are  chosen  so  that  the  control  system  (second-order)  shows 
a reas^  .at'le  transien*  behavior  and  that  the  Inertial  height  follows  the  barometric  height 
well.  For  the  te'.  t flights,  K and  were  chosen  such  that  K : 2/T  and  K,  = 1/T'  with 
T : 30  -econd".  ; that  is,  the  (wo  polts  of  the  control  system  were  identical.  As  a result 

rj  [ this  soft  coupling,  the  inertial  height  follows  long-term  alterations  of  the  barometric 
heigh*  , but  smoothes  out  its  short-term  fluctuations  (see  Figure  30). 

kn  a c « 1 » rome  t e r bias,  a , In  this  process  produces  steady  velocity  and  height  errors 
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For  • « 10  g,  tha  arrora  for  T « SO  aaoonda  ahoN  &H1  w 1 natar  and  dv-  •*  0.06  aatar 

par  aacond.  Tha  Mixing  procaaa  haa  tha  drawback  that  tha  Indlcatad  halght  (baro-lnartial 
haight)  atlll  haa  tha  aama  low-fraquancy  arrora,  aapaclally  thoaa  dapandant  upon  tha 
waathar  and  aanaor  poaltlon. 


4.3.2  Optimal  baro-INS 

Tha  uaa  of  a Kalman  flltar  in  aiding  the  vertical  channel  of  tha  platform  makas  it 
poaaibla  to  create  tha  optimum  combination  of  inertial  and  barometric  halght  by  consider- 
ing tha  errors  in  each  kind  of  information.  The  filter  can  be  arranged  so  that  it  also 
corrects,  in  the  optimum  manner,  the  vertical  velocity  and  acceleration  (sea  Figure  31). 

The  basis  for  tha  Kalman  filter  is  an  eight-dimensional  error  model  for  the  sensors  (plat- 
form and  barometric  height  meter).  This  error  model  Is  shown  in  Figure  32.  Part  (p  of 
Figure  32  shews  the  error  model  for  the  vertical  channel  of  the  platform.  The  gravity 
correction  is  no  longer  calculated  wit'.,  the  inertial  height.  Hi,  but  with  the  barometric 
height,  HB.  In  this  manner,  the  positive  feedback  of  an  inertial  height  error  onto  accel- 
eration is  avoided.  Part  (f)  of  Figure  32  shows  the  error  model  for  the  barometric  height 
measurement.  In  addition  an  additive  uncorrelated  error  (white  noise,  WRg)  is  assumed. 

Part  (3)  of  Figure  32  describes  the  error  in  the  measurement  of  the  aircraft's  height  by 
a ground-based  target-following  radar  giving  white  noise,  WRj^  (the  measured  quantities  Z^ 
or  Z2  are  the  differences  between  the  inertial,  barometric,  and  radar  height  of  the  air- 
craft ) . 

The  following  two  configurations  are  considered: 

(1)  The  bnro-inertial  system  that  is  the  optimum  combination 

the.  platform  with  the  barometric  height  meter. 

(2)  The  baro-inartial  radar  system  that  is  the  optimum  combi- 
nation of  the  platform  with  the  barometric  height  meter 

and  the  ground-based  radar(reference  system^  see  Figure  33), 

The  operation  of  the  Kalman  filter  in  the  baro-inertial  system  is  illustrated  in 
Figure  31.  The  difference  between  the  inertial  and  barometric  height  is  fed  into  the 
Kalman  filter.  The  filter  then  estimates  the  errors  of  the  two  heights  on  the  basis  of 
the  model  shown  in  Figure  32,  and  computes  the  correction  signals  for  the  vertical  accel- 
eration and  velocity  as  well  as  for  the  barometric  height. 

In  the  analysis  of  the  test  flights,  a time-discrete  filter  algorithm  is  used.  Every 
10  seconds  a Kalman  filter  iteration  takes  place,  and  the  vertical  acceleration,  velocity, 
and  barometric  height  are  corrected.  The  results  are  presented  in  the  following. 

Part  of  the  test  flights  of  the  HFB  320  had  been  tracked  by  the  target-following 
radar.  The  radar  installation  measures  both  the  distance  tc  the  aircraft,  and  the  elevation 
angle.  From  these  two  measurements,  after  considering  the  corrections  required  by  the  re- 
fraction of  the  radar  beam,  the  height  of  the  aircraft  above  sea  level  can  be  calculated. 

The  optimum  mix  of  inertial,  barometric,  and  radar  heights  is  used  as  the  reference  height 
profile.  This  combination  is  made  with  a Kalman  filter  based  on  the  full  model  shown  in 
Figure  32. 

An  example  of  this  is  shown  in  Figure  34.  Curve  shows  the  height  profile  of  the 

flight  obtained  by  the  conventional  mixing  of  the  vertical  channel  with  the  barometric 
height.  Similarly,  Curve  @ shows  the  radar  measurements.  The  difference  of  height  is 
some  150  meters.  It  is  illustrated  again  on  a magnified  scale  in  Figure  35  together  with 
the  range  of  the  aircraft  from  the  radar.  The  uncorrelated  noise,  which  arises  from  measure- 
ments of  the  elevation  angle  can  be  clearly  recognized.  The  measurement  of  distance  is 
accurate  up  to  a few  meters.  A bias  error  in  the  elevation  angle  would  lead  to  a height 
error  proportional  to  the  distance;  such  an  error  cannot  be  detected. 

The  standard  deviations  { lo  values)  of  the  heigt  errors  and  the  errors  of  the 
vertical  velocity  are  calculated  using  the  data  of  a typical  test  flight  and  the  error 
model.  It  Is  assumed  here  that  the  parameters  tp,  c , and  c of  the  model  shown  in  Figure 
32  are  not  known.  The  Kalman  filter  estimates  them  With  the  nelp  of  the  sensors. 

Figure  35  Shows  the  accuracy  of  the  altitude  measurement  of  the  reference  system 
(Curve  @ ) which  consists  of  the  radar,  the  LN3,  and  the  barometer.  Curve  @ shows  the 
accuracy  obtained  by  the  optimal  mixing  of  LN3  and  barometer.  Curve  @ is  the  lo  error 
of  the  pressure  altimeter  for  the  flight  considered. 

The  error  of  the  vertical  velocity  from  the  baro-lnertial  system  is  shown  in 
Figure  37.  Accuracy  depends  on  the  strength  of  the  accelaratlon  noise  of  the  INS;  at 
10'^  g ( lo ) the  velocity  error  Is  about  0.4  meter  per  second  ( lo  ) ; at  lO'"  g it  is  about 
0.1  meter  per  sec.tr.d  ( lo  ) . The  analysis  of  the  baro- 1 n« r 1 1 a 1 radar  aystam  haa  shown  that 
the  accuracy  of  the  vertical  velocity  is  not  improved  by  tha  addition  of  tha  ground-based 
ca  i.-ir  a/steiTi.  The  velocity  error  Is  determined  by  the  quality  of  the  platform  (eee 
Fi^i'ire  i >1  j . In  figure  13  tfie  reference  altitude  profile  Is  plotted,  and  the  altitude 
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sstablished  by  mixing  th«  platform  with  the  barometric  height  meter^and  the  radar  height. 

It  can  be  seen  that  the  high  noiae  conten;.  of  the  radar  height  has  been  filtered  out. 

The  flight  tests  have  shown  that  with  conventional  mixing  of  the  inertial  height 
with  the  barometric  heighti  the  high-frequency  errors  (noise)  of  the  barometric  height 
measurements  a’"e  smoothed  out,  but  the  considerable  error  caused  by  the  weather,  some 
100  maters  ( lo ) , ,ind  by  the  wrong  measurement  of  the  static  pressure,  some  70  meters  ( lo ) , 
remain  unchanged.  If  the  two  forms  of  height  information  (inertial  and  barometric)  are 
combined  by  means  of  a Kalman  filter,  then  the  good  short-term  accuracy  of  the  vertical 
channel  of  the  platform  can  also  be  used  to  correct,  to  a great  extent,  the  low-frequency 
errors.  The  accuracy  with  which  this  is  possible  depends  on  the  quality  of  the  platform 
used.  In  the  case  of  a platform  of  inertial  quality  (LN3),  while  making  the  most  un- 
favorable assumptions  about  the  weather  and  pressure-measurement  errors,  the  helgt  error 
can  be  reduced  to  less  than  50  meters  ( lo ) . If  the  weather  parameters,  e^,  and  e^, 

have  been  obtained  from  the  weather  oharts  and  the  parameter,  Cp,  from  a calibration  curve 
then  using  the  Kalman  filter  for  the  correction  of  these  errors  , the  height  error  can  be 
reduced  to  some  10  to  IS  meters  ( lo  ) . 

The  reference  height  generated  using  a Kalman  filter  with  optimum  mixing  of  the 
barometric  and  inertial  heights,  with  the  height  as  measured  by  ground-based  target-fol- 
lowing radar,  has  an  error  which  is  less  than  10  meters  ( lo ) . 

The  vertical  velocity  can  be  measured  by  means  of  optimum  mixing  of  the  inertial 
with  the  barometric  height,  with  an  accuracy  of  up  to  0.1  meter  per  second  ( lo  ) . This 
accuracy  cannot  be  increased  by  including  the  measurements  from  the  target-following  radar. 

These  comments  apply  naturally  only  to  flight  profiles  comparable  to  those  considered 
here,  i.e.,  a range  of  some  100  kilometers,  flight  height  of  some  6000  meters,  and  a 
velocity  of  some  100  meters  per  second. 


5.  CONCLUSIONS 

Aiding  the  INS  with  a Doppler  radar  and  a pressure  altimeter  is  a means  to  consider- 
ably improve  the  position  and  velocity  accuracy.  For  the  evaluation  of  flight  tests,  a 
high-precision  reference  system  is  required,  which  has  been  realised  at  the  DFVLR,  Braun- 
schweig, by  smoothing  the  data  of  a tracking  radar  with  the  help  of  the  INS.  Flight  tests 
have  demonstrated  the  high  performance  of  the  optimal  hybrid  navigation  systems,  and  have 
shown  that  this  navigational  accuracy  can  be  obtained  with  filters  of  reasonable  size,  if 
their  sensitivity  to  the  model  simplifications  is  carefully  analyzed  and  minimized. 
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Fig.  5 Horizontal  accelerations  measured  by  the  INS 
during  the  flight  shown  in  Fig.  3. 
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Fig.  9 Pofition  errors  in  the  horizontal  channels  of  the  uncalibrated 
L.N3  platform  during  a laboratory  test  run. 


Vi<.  Ill  Arcrleratinn  and  velocity  errors  of  the  uncalibrated  LNl  platform, 
corresponding  to  Fig.  9. 


Fig.  II  Simplifi«d  error  model  for  the  tN3  inertial  platform. 
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FLg.  22  Error  diagram  of  the  third-order  gyrocompassing  loop 


1 


Fig,  33  Scheaatic  dicgram  of  the  reference  eyeten, 
coneieting  of  LM3,  eltioecer,  and  radar. 


Fig.  34  Altitude  profiles  nieasured  by  the  conventional 
baro-inertial  loop  and  by  the  tracking  radar. 
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RESUME 

Deux  Atu.les  de  SAOEM  eti  filtrate  t-rilrml,  sont  prfser.tfes  riana  oe  papier  aver  lea 
exp^ r Iment at  ions  asso.'i#«fa. 

(t)  Un  syatJrie  d»-  navination  afronau'.  iqu>-  inert  ie-Doppl  er-r-'ea  lape  de  position  a 

test?  avec  succ?s.  Le  module  matlrfmat ique  utllis?,  ainsi  que  la  description  du 
pro^rranne  de  6000  siots  r?partia  en  deux  calculate jrs  et  lea  r?sultats  de  I’expf-ri- 
sjentat  icn , sent  donnAs. 

‘ ; L ' al iffnener.t  rapide  d'une  p’ate-fornie  S inert  ie  eat  le  deuxi?me  cas  prtsenl?.  La 
nod?lisa*icn  retenue  est  simple  et  les  ^ains  ebtenut  sent  importants  : pour  des 
precisions  comparables,  1 ' a 1 i cnement  optimal  dure  ‘*^0  seccrides  S comparer  aux 
lOti  secondes  d’un  aliirnement  clnssique.  Le  programme  ci-pendant  utilise  1800  nets 
du  caiculateur. 

Enfin,  des  consideration':  (?6n?rales  sur  1 ’ enp;  ineer  i np  des  filtres  sent  donnfes , 
part icul i?rement  en  ce  qui  concerne  la  mftnodolopie  penfrale,  et  les  mfthodes 
d'aide  3 la  i roprammat  ion  ; Iv.-  system-  DASH  (liispositif  d'Aide  3 l.a  Proprammation 
des  Syst?mes  Hytrides)  levelopp?  par  SAGEM,  est  pifsent?  rapidement. 


SUMMARY 

T'.’.is  paper  describes  in  detail  two  systems  usinp  Kalman  Cilterinp  which  were  deve- 
loped and  experimented  by  SAGEM. 

( ’. ) A hycrid  inert  ial-Doppler-pos  it  ion  reset  nc.vipator  war.  studied  and  experimented 
from  196?  to  19VS. 

The  technolopy  for  both  inertial  platform  and  the  computer  goes  back  to  19&0.  The 
mathematical  model  uses  a 19-state  vector.  The  numerical  algorithms  were  studied 
and  implemented  with  care,  usinp  the  t-technique  to  avoid  sensivity  problems. 

The  conp.ete  program  was  split  into  two  computers,  and  the  subprogram  correspon- 
ding to  'he  filter  represented  about  6000  words,  over  11000  for  the  total.  Curves 
are  given  both  .'or  theoretical  performances , and  for  expierimcntal  flight  results. 

(?)  Algorithms  and  software  for  optimal  alignment  of  an  inertial  platform  were  dcvelopped 
and  tested  from  19??  to  19?‘i. 

The  inertia]  system  used  for  the  experiment  is  an  M'lC  of  .CAGEM.  Th.e  mathematical 
model  i.s  quite  simple,  and  the  complete  alignment  program  user  IBOO  words.  The 
improvement  ir:  alignnenc  time  is  quite  imprer-sive  ; AhO  second?  for  optimal  alignment, 
t be  compareu  to  1051  seconds  for  c!a:'sical  alignment. 

Tnen  the  paper  gives  in  its  fourth  part  general  cons iderat ions  on  filter  engineering  ; 
(1;  G-r.eral  methodology  used  by  llAGEM  is  presented. 

(J)  .-’rcm  tt.e  experience  gained  during  the  design  and  test  of  system  (1),  SAGE.M  has 

ceme  to  trie  conclusion  that  one  needs  a quite  involved  facility  to  test  and 
valid  real  time  program,  of  the  complexity  of  an  iiyt.riJ  inertial  navipatcr  ; wo 
nave  desigr!“d  such  a facility  we  call  i.'ACH  (t'ystem  for  testing  and  validating,, 
programs  for 'hybrid  systems)  wnich  is  quiekly  d's-scr  ibed . 

1.  "tiThoLcCT  ;or; 


Cfjncevr, ; r un  r.yster.e  de  nav  igat  icn  hybride  optimal,  e'ert  I's.suil  i e llement  resoud-e  un 
prohlAme  1 ' lit  i 1 i .ra  t ion  optimale  d ' i nforr.a  t i nn  , [.rol.l?me  po.re  depui.-:  fort  1 ongt  einps  er. 
r.ei-nce.s  et  en  tee>,n  i qije.s  , et  moteur  e;-,  ;;..nt  iel  p.'iir  le  .!•' ve  leppement  du  caU’ul  des  probnbi- 

lir.e:^  e>  qe  ] t ,1 ' 1 s t i q u e . 

r '.  y r.'-mr  reux  preeiirr.eurs  illiirtrer.  dent  'iau.".  s , hap  1 are . . . ; il  i'allii;  attendre 

■efenlar,’,  ‘''i  ['uir  qije  ;>•:•,  [e.-  ,;m-  ,-n  s.ys I ener  d'arme;.  et  svstemec  de  riTmut:',- 

■a’i'r  a hau'e.-,  ; e r f' rnar.-er  c'.ndu  i.-ep.'  .'’t.ann’-n  I '.  1 ei  WiereT  |,  | a ef|-,.i.  tuei'  ,i,  t ravaux 

r r.laren- aux  iar..-  lomin*'.  /air.  1 ’ on  p.  ut  e..n.r  idef-r  que  c'e;-,t  gi-ace  au  ,!evi.  1 epj  .'m..  • • 

y,.f  . 1,,  raineriuue  -t'une  jarf  .-t  .q  1 ' i nt  ro.hu- 1 i n par  K.almanil'l  '<  l'-))'l.  i 

j,.-  1.,  '•;-,*r-ige  • a r i s • iq..e  ,!'-r.i*re  jart  .ju.-  ;'.n  a in  env  i : ag.  r a j iio;r 

h ar.r.ee  > 1<  ■ le;-,  . vs' •'•r.er  q * inanx  f ue''  i' nnar;f  ' enp.-  r>'...'.  j 
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La  rialisatton  dt  ayat^maa  da  navigation  a pu  Hra  efraotuCe  aveo  auocta  par  caa 
«Atho4aa,  Bn  affat«  U navigation  oonalata  I dBtarnlnar  lea  paramBtras  fondamentaux 
qua  aont  la  poaitlon,  la  vltaaaa  at  I'attituda  (cap  at  ve^tloale)  d'un  vdhicule  I 
do  captaura  ou  ayattaaa  donnant  daa  Int'ormatlona  la  plua  aouvant  redondantea. 

Laa  praniiraa  applioatlona  ont  au  lieu  au  ooura  daa  anndca  196}  B 1965  (voir  (6]  B 
1171  ). 

SAOBM  a mand,  dBa  1967.  plualaura  Btudaa  at  axpSrlmentationa  da  ayatBmaa  de  naviga- 
tion an  utilisant  laa  taohniquaa  da  riltrege  numBrique  da  Kalman  ([iB]  B [21]  ). 

Noua  axpoaarona  an  dBtail  aux  aactiona  2 at  } laa  rSaliaationa  auivantea  ; 

(1)  SyatBma  da  navigation  hybrida  inartia/Dopplar/reealaga  da  position  pour  application 
aBronautiqua  rBaliaB  at  expBrimantB  da  1967  B 1972. 

(2)  Alignement  rapide  optimal  d'un  systSmo  B inertia  rfialisB  et  expBrimentB  de  1972  B 
1975. 

Les  considBrations  gBnBrales  qui  suivront  B la  section  4 s’appuient  aur  I’expBrience 
acquise  par  SAGEM  au  eours  de  la  rBalisation  dea  systSmea  prBcBdents  et  d'autrea  ayatBmea 
(achevBe  ou  en  cours)  qui  aont  : 

(1)  Filtrage  inertie/VOR/DME  et  filtrage  inertie/ILS  pour  I’aBronautique  civile. 

(2)  SystSme  de  navigation  de  rBfBrence  et  alignement  B la  mer  dea  ayatSmes  B inertie 
du  Super-Etendard. 

(3)  SyatBme  inertie/Loch/Tranait  pour  ia  localiaation  prBciae  pour  recherche  gBophyai- 
que  marine. 

(4)  SyatSmea  performanta  utilisant  plusieurs  plateformea. 


2.  SYSTEMS  DE  NAVIGATION  AERONAmiQUE  EXPERIMENTAL 

Cette  Btude  et  I’expBrimentation  asaociBe  ont  StB  rBalisBes  dans  le  cadre  d'un 
eontrat  avec  le  Service  Technique  ABronautique. 

Le  systSme  de  navigation  hybride  expBrimentB  intBgre  les  informations  redondantea 
d’un  systime  B inertie,  d'un  radar  Doppler,  de  recalage  de  position  8 partir  de  moyens 
divers  et  d'une  oentrale  baromBtrique . Les  trois  premiBres  informations  sont  traitBes 
par  nn  filtre  de  Kalman,  la  derniBre  eat  utilisBe  de  fa?on  classique. 

AprBs  la  description  dea  Bquipementa,  on  prBsente  le  modSle  markovien  du  systSme 
hybride  -choisi  aprBs  I'Btude  de  performance  et  de  senaibilitB-, les  caractBristiques 
des  programmes  de  filtrage,  les  difficulcBs  rencontrBes  dans  la  rBalisation  pratique 
du  filtrage,  les  mBthodes  de  mise  au  point  utilisBes  et  les  rBsultats  des  essais  au  sol 
et  des  essais  en  vol. 


2. 1 Description  de  1 ' installation  d'essais 


2.1.1  Les_BguiBements  (Hardware) 

La  figure  1 dBcrit  le  schBma  de  1' installation  expBrimentale  montfee  sur  la 
Caravelle  du  Centre  d'Essais  en  Vol  de  BrBtigny  (CEV). 

La  base  de  1* installation  est  un  systBme  de  navigation  8 inertie,  dont  la  technc- 
logie  date  de  1965-1966.  C'est  un  systSme  en  plusieurs  boltes,  dont  les  performances  de 
navigation  sont  de  la  classe  1,5  mille  nautique  par  heure,  CEP.  Ce  systime,  etudiB  pour 
avion  d'armes,  utilise  un  caloulateur  numBrique  embarqufe  dont  le  temps  d'addition  est  de 
39  microsecondes  et  la  capacitB  mBmoire  d'environ  8 kilo-mots  de  24  bits.  Les  fonctions 
programmBes  de  fagon  standard  dans  ce  calculateur  sont  nombreuses  et  comprennent  la 
conduite  de  la  plate-forme  en  alignement  et  navigation,  des  couplages  classiques  aooBlB- 
romBtre  de  verticale-altitude  baromBtrique  et  inertie-Doppler , la  navigation  automatique 
lo  long  d'une  trajectoire  dBfinie  par  points  tournants,  le  recalage  simple  de  position 
et  la  conduite  des  visualisations  et  des  commandes  du  systBme. 

La  puissance  de  calcul  et  la  .nBmoire  restant  disponibleo , Btant  insuffisantes  pour  les 
hesoins  du  filtre  de  Kalman,  on  a choisi  d'ajouter  un  caloulateur  identique,  en  dBfinis- 
sant  ainsi  une  structure  de  calcul  parallBle.  Le  dialogue  entre  les  deux  caloulateurs  se 
fait  par  1 ' intermBdiaire  d'une  mBmoire  tampon  de  600  bits  en  technologie  MOS.  Les  oalou- 
lateurs  fonctionnent  de  fagon  asynchrone  sur  le  principe  "maitre-esclave" . La  calculateur 
1,  celui  du  systBme  3 inertie,  est  le  maitre.  II  dBfinit  le  rythme  gBnBral  des  oalculs  et 
den  Bchanges  avec  le  caloulateur  2,  I'esclave. 

Le  radar  Doppler,  qui  fournit  1 ' information  redondante  de  vitesse,  est  un  Doppler  moderne 
3 antenne  fi/o.  II  donne  les  composantes  longitudinale  et  transversale  de  la  vitesse  sol 
sous  forme  de  frBquences  d ' impulsions . Son  domaine  d 'utilisation  est  prinoipalement 
fonction  de  I'assiette  avion,  de  I'altitude  et  de  la  nature  de  la  zone  survolBe,  terre 
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FIGURE  1 - INSTALLATION  EN  ESSAIS  SUR  CARAVELLE  AU  CEV 
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FIGUKE  - PONCTIONNEMENT  EN  BOUCLE  OUVERTE  (B.O)  OU  FERMEE  (B.F) 
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ou  mer. 

L'altltude  est  donnfie  par  la  centrale  afirodynamlque  du  bord  dont  le  traduoteur  de 
preaaion  est  du  type  m^oanique  classlque. 

Lea  recalagea  de  position  aont  effectu^a  au  moyen  du  bottler  de  visualisation  et 
d'entrfiea  numCrlquea  du  systdroe  i inertle.  Ila  aont  faits  8 partir  de  moyena  diyera  en 
particulier  un  hypoacope.  La  visualisation  permet  6galement  I'afflchage  de  la  poaition 
donnSe  par  I'lnertle  et  de  son  eatimfie  donn€e  par'  le  filtre. 

Le  calculateur  2 est  connect^  3 un  enregiatreur  magn#tique  embarquS,  qui  toutes  les 
50  secondes,  eininagaslne  les  12*t  paramdtres  les  plus  significatlfs  du  fonctionnement  du 
filtre. 

Les  caract^ristiques  gfnfirales  dea  nrincipaux  §quipements  sont  donn^es  par  les 
tableaux  183. 


2.1.2  Les_modes_de_fgnctionnement 
(1)  M2des_de_navigatign 

La  redondance  des  informations  de  I'inertie,  du  Doppler  et  du  recalage  de 
position  est  utilisfe  pour  <f6finir  plusieurs  modes  de  navigation  : 


(a) 

inertie  pure 

(b) 

inertie-recalage  de  position 

optimal 

(e) 

inertie-Doppler  optimal 

(d) 

inertie-Doppler-recalage  de 

position  optimal 

(2) 

Un  s^lecteur  permet  de  commander  pour  les  mooes  b,  c et  d,  un  fonctionnement 
en’boucle  ouverte  (BO)  ou  en  boucle  ferm^e  (BF),  qui  est  schfimatis§  par  la 
figure  2, 

Dans  le  fonctionnement  en  boucle  ouverte,  les  parametres  de  navigation  et 
d'attitude  sont  corrig§s  3 I'extSrieur,  avant  utilisation.  Le  syst§me  3 inertie 
reste  autonome. 

Dans  le  fonctionnement  en  boucle  fermee,  certaines  composantes  du  vecteur 
d'etat  sont  corrigees  dans  le  systdme  3 inertie.  En  toute  rigueur,  cette 
correction  devrait  etre  faite  sans  retard  et  instantanement  . En  pratique, 
compte  tenu  de  la  charge  de  calcul,  la  correction  est  effectuee  avec  environ 
un  derni  pas  de  retard  (26  secondes).  Suivant  les  oaramdtres,  la  correction 
est  ; 

(a)  instantanee,  pour  les  grandeurs  numeriques  de  position,  vitesse,  derives 
et  facteurs  d'echelle  des  gyroscopes. 

(h)  progressive,  pour  I'attitude  plateforme,  par  commande  des  gyroscopes 
dont  la  vitesse  de  precession  est  limitee. 

Le  fonctionnement  en  bou:le  fermee  permet  en  particulier  I'alignement  en  vol 
de  la  plateforme.  En  outre,  dans  certains  cas  le  controle  des  erreurs  incr- 
tielles  peut  etre  necessaire  pour  satisfaire  I'hypothese  de  lin^arite.  Cepen- 
dant,  le  fonctionnement  en  boucle  fermee  a 1 ' inconvenient  de  dfitruire  I'auto- 
nomie  du  systeme  3 inertie  et  de  degrader  ainsi  la  fiabilite  de  see  informa- 
t ions . 


( 5)  Util i sat ign_de_12,infgrmation_barometrigue 

L' information  d'altitude  baromftrique  n'est  pas  integree  par  le  filtre,  pour 
des  raisons  de  simplicity,  car  I'altitude  n'est  pas  un  param&trc  critique. 
Cependant,  on  realise  un  couplage  3 gain  constant  avec  1 ' acceleromdtre 
vertical.  Ce  couplage  fournit  I'altitude  et  la  vites.se  verticale.  Un  .syiccteur 
permet  ou  non  de  les  utiliser  dans  la  mScanisation  du  systSme  3 inertie  et 
dan.s  la  matrice  observation  du  filtre. 


2 . 2 Modele  markovien  des  erreurs  du  systgme  hybride 

Cette  experimentation  a ete  precydye  d'une  etude  importante  suivant  les  ytapes  d'une 
rn-'-thodologie  qyi  sera  commentee  3 la  section  *) . Leo  etudes  do  performances  et  do  sensibi- 
Ht''  orit  conduit  a adopter  le  module  markovien  suivant  des  erreurs  du  systeme  hybride. 


TABLEAU  1 - CALCULATEUR  EMBARQUE  SAOEM 


AE  . 51  . A 


. Technologic  (1965) 

- circuit  intfgrf 

- mSmoire  3 tambour  miniature  3 palier  hydrodynamique 

. Capacit#  mSmoire  B709  mots  de  2<f  bits 

- programme  non  modifiable  ; 7680  mots 

- travail  : 6l»5  mots 

- systSme  : mots 

. Structure  s6rie  parallJle  comprenant 

- une  unit^  arithni6tique  universelle 

- un  analyseur  diffSrentiel  num6rique 

. Operation  en  virgule  fixe 

. Possibility  de  programmer  deux  op6rations  simultanyes 
. Horloge  : 6J»0  kHz 

. Temps  opyratoire 

- addition  : 39  us 

- multiplication  ! ,39  us 

- division  (sur  2*1  bits)  : 1000  us  (programmation  simultanye  d'op§- 

rations  toutes  les  59  us) 

. Entree/sortie  programmye,  serie 
. Poids  ; 21  Kg 
. Volume  3/*<  ATR  : 18  1. 


TABLEAU  2 - SYSTEME  A INERTIE  SAGEM  - S.  Ill 

, Systeme  prototype  pour  avion  d'armes 
. Technologic  1966 

. Gyroscopes  flottants  3 un  degrf  de  liberty 
. Plat'-forme  toute  attitude  3 quatre  axes  de  cardan 
. Calculateur  universel  digital  AE  51  A 

. MAcanisation  toute  latitude  asservie  3 un  pole  arbitraire 

. Precis  ion  : de  la  classe  1,5  nm/h,  CEP. 
— 
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TABLEAU  3 - HADAR  DOPPPLER  EMD  . DECCA  - 72 


TABLEAU  14  - DEFINITION  DES  SYMBOLES 


GRANDEUR 

DIMENSION 

DEFINITION 

X 

15 

X 

1 

Vecteui-  d’etat  d'erreur  du  syst&me  hybride 

f = [S" 

F22J 

15 

X 

15 

Matrice  dynamique  du  syct&me  hybride. 

u 

15 

X 

1 

Bruit  excitant,  gaussien  ccntr6,  non  corr§l6 

Q 

15 

X 

15 

Covariance  de  u,  matrice  diagonale. 

y 

I4 

X 

1 

Vecteur  d' observation. 

H 

14 

X 

15 

Matrice  d'observation. 

V 

14 

X 

1 

Bruit  des  observations,  gaussien  centrS, 
non  corr§le. 

R 

14 

X 

14 

Covariance  de  v,  matrice  diagonale. 

♦ . 

♦12I 

15 

X 

15 

Matrice  de  transition. 

Lo 

♦22J 

X 

15 

X 

1 

Meilleure  estimee  de  I'erreur  du  systeme 
hybride . 

r 

15 

X 

15 

Covariance  des  erreurs  residuelles. 

K 

15 

X 

14 

Gain  du  filtre. 

V 

15 

X 

15 

Diagonale  de  i 

C 

1 

X 

1 

Coefficient  de  d^sensibilisation  du  filtre, 
compris  entre  0 et  1 . 

h 

1 

X 

1 

Pas  numfrin'ie  du  filtre  (50  s) 

h* 

1 

X 

1 

Pas  num^rique  fraccionne  (10  s) 

TABLEA'.'  o 


UTILISATION  DES  CALCULATE'JRS 


VOLUVF. 


r 


MEKQIRF. 


8Q  t 


TEMPS 


95 


CALCUL 


X 


60  X 


1 

j 


Alip.nement 

9.V’> 

Navigation 

900 

V i sual i sat  ion 

■ i 05 

KalfTian 

O 

o 

Divers 

1 » r n 

TOTAL  6J0C 


Eulriar,  y.'DC 

r.'  i V e r r.  1000 


h 


TOTAL 


TOTAL  GENFFAI 


A ',’00 


11000  Mots 


TOTAL  KALMAN 


9700  Mots 
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avee 
et  oQ 


X = Px  + u ( 1 ) 

x'  s Ixi ’ , X2 ' , X3' ] (2) 

xi  = vecteur  d'<^tat  des  erreurs  dynatniques  du  ayatSme  & 
inertle, 

X?  = vecteur  d'6tat  dea  erreurs  des  composants  du  systSme 
3 inertie, 

X3  = vecteur  d'§tat  des  erreurs  du  Doppler. 


2.3.1  Errsyrs_d^nami2ues_du_syst&me_3_ inertie 

On  a choisi  la  description  classique  121]  par  deux  systSmes  d'Squations  difff-ren- 
tielles  projet^es  sur  les  axes  plateforme  : les  fquations  en  it  et  les  Equations  d'erreurs 
de  position.  Cette  description  conduit  3 des  Equations  simples.  Le  vecteur  d'§tat  corres- 
pcndant  est  : 

xi  = [*^.  *y.  «x,  4y,  4x,  «yl’  (3) 

ol 

*y>  *y’  *2  ■ rotations  autour  des  axes  plateforme  faisant  passer  du  repSre  calculateur 
^ "HI  repore  plateforme. 

4x,  4y  : erreurs  horitontaler  de  position  dan.s  les  axes  plateforme. 

4x  5y  : dfrivfes  temporelles  de  5x  et  6y. 


2.2.3  5-iL'Sr^if  i® 

A la  suite  de  l'6tude  de  sensibility  les  biais  des  acc6iyrom3tres  et  les  balourds 
des  gyroscopes  ont  ete  nf-Rl ipfs . Les  seules  erreurs  retenues  sont  les  derives  et  facteurs 
d'ychelle  des  piyroscopes.  Le  module  pris  pour  la  derive  et  suegfry  par  I'experience  est  : 


c = -6c  + u ( <4 ) 

ou 

c = derive  aleatcire,  variable  au  cours  du  vol , dont  le  modele  choisi  est  du 
premier  ordre. 

u - bi  iit  b lane  . 

Ce  modele  permet  de  representer  aussi  bicn  un  signal  a temps  d ' autocorrelat i on 
T : 1/6  qu'un  cheminemont  aleatoire,  si  6 - 0. 

L'pxperience  conduit  3 con.siderer  le  factevir  d'echelle  comme  constant  au  cours 
du  vol  et  varia!  1--  d'ur.  Jour  a I'autre.  Le  modele  correspondant  est  done  : 


K - 
g 


O 


vfotpur  ti'‘'tat  dec  erreurs  dc  pyro.acope 


r. 'ecrit  alcrs 


(5) 


X2 


(c. 


p:y 


V' 


(6) 


3.3.  ' firreura_du_Dopp  lor 

four  r.opploT  l'''ludc  do  .aenc ib i 1 i te  conduit  3 n^gliger  le  facteur 

1 ' fo  ; ; : .-.oui'’;:  rr>urr-  rt  I'-nuor.  nont  ijor.  b i .a  i .a  sur  ciinquo  .axe,  constanlr.  au  coui'r. 

t'i  V'  1 •na  i a l-'ui  • M i for;  I'un  vol  .3  l'aut,r<',  ooci  pour  dor,  limito.",  d ' ut  i 1 isat  i on  prooioor 
' V i r-  :;o., 


' d ■- 


[,o  7,.  u'oi.i*  lor  orroura  iM.pplor  o.-.t  par  ronr.oi^uf'tit 


CV) 


X 1 


f r 


!x’  dy 


I ' 


mi' 


;t  A 


■ I II 

■it/  C4i  s i..i  kj/  i 


510 


I P'jUU'M  me;  iii‘<  «‘  1 !<•.;  ' 1.:;  t ;itit  .■  il ! :u-c>-(  ;;  p'lr  ‘liv-fi:  moyt-ri:!.  Oti  oon:. 

,juf  ’.>*s  < i'.  .I'mif  ■n--. .'i  rj’i ' t>  1 l*-;J  sotiL  carac  t >' i- i 

paf  leuf  I'KK. 

' L'v.'of  ij.  • U r.  Uv.'  ; i-otvaffirii-.'  w’.'i'iAai''' ' 

l.'s  laMeaux  **  ft  pi'-'.ieiu f*n.  l.*s  t'-'pr, • ^ a>-  rnt.i-a/.f  programinf-e;'.  ain;-i  quc 

l-.'y  Motatiojui  J-;;  viv' t f.HT.  ol  natfiooa  utili.-'  . 

1-.';;  t‘  :t.u  It-;; -ci ' iriv.f  .'rat,  iot;  •'■t  ^1>'  ra  : ■ : ' Ic  la  matriro  df-  Lranrition  'ivt-r'.’ jptarl'Tit 
'<  ‘Ti  al  i tl.rrn-  HuriRO-Kut  t a I'ordf--  l.iix  .|a  i riiriiniao  If;!  '..'rroura  . l.a  .■■:atfic'-  vU’  i,  rari.:  i t i oti 
a dO  i,-,uip>''  •'!!  d.'ux  i'loof.  au  i c a 1 ou  1 .'ur  df3  par.  d i fff  I’l'iilr, , id  rl  ‘jJ  ::rc:o;ui'--r 

trur  df;i  :-ai.,:;r  do  i-ror  i ; .'ri  di'-v.- ! at  i a la  r.offioti  . d . 

loa  I'a'.rit  i onr  o larr  ititn'a  du  i’iltr*-  do  Kalman  oti*  '■ta'  mod  i 1' 1 ''I’r.  pour  inrluri'  la 
tfchn  iiiu-'  d>‘  l**'r"  to  d<^a>  nr  1 1>  1 1 ; a*  ioii  atix  orrourr  dt*  modolt'r  rt;  aux  orroiirr  t'.unrri  quo.' . 

la  ropar’ltu'ii  d r ; rfatrammor  a ot-'  pr  ItiC  ipalomont  dictoc  par  lor.  aotd  ra  i ;it 
r ivan*  .■.!  : 

un-.'  Var.tto  pat'lio  de  la  momoiro  -'t  d.o  ’a  puirranco  du  calotilatour  1 tu;L  'jliliroo  par 

lor  pr  .'i-rammo,,  ri  .ao  i f 1 quo.;  du  r, yr t >'t::o  a it.i-rl  ii... 

V-  ' un  rortai,!:  '..'mbro  Jo  ..'aloulr  dail  ot.fo  I'n  i t on  fh'tianL,  pour  d'-r  raironr  d"  proei- 
ri'.'u  ;u"  1' v.' '.oj  p-'o;;  plur  l''in. 

pat"  a.-o  d-T  pr  Mramra.:;  ot  la  .-a  .'o  ; a 1 i rat  i oti  dcs  ca  Ifulatourr  on  "fixo"  ol  on 
";’lv’ tat.'-"  .■on*.  y'vC:-'.'  .'a  *.  i .•  :'a  i r.ar;*  r . Ainri,  lo  '.’alculatour  1 tralto  tour.  I'.'r 

p ro»trar..n,o.r  op  rlxo  oa  1 a'l  1 ■ttauir  . .’<.ux  on  flottnitt  (voir  figure  /i). 

I. or  eol’..a:..-o,',  or.tro  calculat  o.|p  pot,*,,  or;  roric,  par  tranal’er*:  profiramm*',  verr  la 
.a-rj;.,,  Lp  d-'bit  do  '.'o  mrdo  d--  t rarutmi  .tr  i on  rrt  faihlo  mais  curfirant  pour* 
'raitor  lo;.  rS  parcimotr.'r  ooV.atu-.'.-  :u;-ant  cnaq'ae  pa.';  de  oalcul  (PO  secondcs). 

1.0  bilar.  d.-r,  cbarper  do  calcttl  ot  dor  *.•;.■  1;. mo r.omoiro  utilirer  ost  donno  p-ar  lor 
tai  loaux  ‘1  ot  7.  II  o.rt,  imp.jrtant  I.,,  nrt.-r  quo  1 'optimiration  du  -.'clumo  notnoir;. 
n'a  L’a.r  .'t'.  I'cbjootif  principal  d-.r  1 ' ■••xpor 'm.rntat  icti , par  crotro  1 ' opt  imi  rat  i op 
torn:.;-'-  ro-'l  a ot'-  un  .toui'i  pornar.ont. 

1.0  .loro’j  lenor.t  dor  calcuts  r.:>  f.ait  d.j  I'ayon  ary  ncbron.'  d.ar.a  lo.r  deux  oa  1 c'.j  la  teurr 

r.air  av-'c  ur;  contr'lo  rirour-ou;<  du  tc-mpr  r'ol  par  lo  calculateur  1.  (-''oS*.  co  derr.ior  <pui 

dofinit  Iri  dnroo  iu  par  d ' i ntoprat  i on , lan.'o  l.>r,  prcrtramrno.r  du  7 .-t  gore  ler  ocl'.anp.or. 
I.or-.rquc  lo  7 a torTiin-:-  un  traitemef.t , il  re  m-ct  on  attente  d'lin  ncuv'cl  ordro  ivoir  rir'uro 

M . 

1..'  d.rq.'i:!.  .1u  p;ir  d ' ir.t  oqrat  i<cti  coTnci.io  avoo  1 ' ocbant  i 1 Icnnapo  do  1 ' c tu;  •■'rv;;  t i on 
D'rpplor.  1. ' Ob  .0  orv'it ; '■'■n  ;lo  r.orii.ion  pn-ut  intorv.-.n  Ir  a n'inporto  qi.ol  inrtant. 

. t l;  1 m cu  1 1. r reri ’ontr.'.:r.  il.'ir;r  la  rd-a  1 i rat  i on  pratitnur  I'u  iMltro 
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En  pratique,  c«>  retard  n'eat  paa  gSnant.  En  boucle  ouverte,  il  se  traduit  par  un 
petard  de  la  correction  de  I'affiohage.  En  boucle  fermfo  11  eat  nCgllgeable  devant 
lea  conatantea  de  tempa  dynamlquea  dea  orreura,  en  partlculier  la  pBrIode  8<(  minutea 
de  1* inert le. 


La  matrice  de  tranaiiion  eat  utlllafe  pour  intfigrer  (et  prfidire)  la  meilleure 
eatimife  dea  erreurs  et  la  matrice  Je  covariance  des  erroura  rfaiduellea.  Le  calcul  de  la 
matrice  de  tranaltion  se  fait  par  integration  de  la  relation. 

* = F*  (9) 

La  precision  de  cette  integration,  qui  depend  done  dea  caractfriatiquea  de  la 
trajectoire,  eonditionne  lea  performnncea  dii  filtre.  Schfmatiquement , pour  un  algorithme 
el  un  objectir  de  precision  donn6a,  plus  lea  Svolutiona  aont  sOv?res,  plua  le  paa  d'inte- 
gration  doit  5tre  petit. 

Le  probl&me  ftait  done  de  cboisir  un  algorithme,  auffisamment  pr6cia  pour  lea 
trajectoirea  envisag^^ea,  donnant  une  charge  et  un  volume  de  calcul  minimal. 

L’id^e  exploit^e  est  de  consid6rer  que  les  termea  len  plus  sensiblea  aux  Evolutions 
sont  eeux  qui  dependent  le  plus  directement  des  erreurs  dynamiques  inertielles,  e'est  3 
dire  le  bloc  (dimensions  7 x 7)  de  ♦.  On  a done  choisi  de  calculer  les  termes  corres- 

pondants  (♦n)  de  la  matrice  de  transition  avec  un  pas  de  10  secondes  et  les  autres  avec 
un  pas  de  50  secondes. 

La  degradation  de  performance  due  3 cet  algorithme  a EtE  calculee.  Elle  est  negli- 
geable  (quelques  pourconts)  pour  des  vols  type  Caravelle.  Elle  serait  rEdibitoire  pour  un 
avion  d'armes.  La  solution  pourrait  etre  alors  une  reduction  du  pas  do  calcul  en  utilisant 
un  calculatevsr  plus  puissant  ou,  si  ce  n'est  pas  possible,  d ' interrompre  simplenient  i'intE- 
gratior.  pendant  les  Evolutions  trop  sEvEres  apr5s  avoir  vErifiE  que  la  dEgradation  corres- 
pondante  est  tolErable. 


t' . t . i CL‘^£i§i£L'-L'y^lCiQU2-I-YiUSUi£-ri3i£-2y-ri2i£SQl£ 

Lo  don, sine  de  variation  des  dlffErents  paramEtros  est  important,  notamment  pour  la 
matrice  de  covariance  dos  orreura  rEsiduelles.  pendatit  1 ' al ignement  en  vol  de  la  plateforme, 
I'Ecart  d'horicontal  initial  est  de  I'ordro  de  quelques  degree,  et  I'Ecart  final  de  I'ordro 
de  la  seconde  d'arc.  I, a plage  do  variation  corrcspondnnte  do  la  covariance  est  do  10^.  Lea 
inpEratifs  de  cadrage  et  d'arrondi  sont  de  I'ordre  de  10^  ou  de  lO’,  e'est  3 dire  un  total 
de  10^  3 lO’®  qui  depasse  les  noss  ihilites  du  met  d(>  bits. 

Peux  solutions  ont  Ete  envisagees  : la  doubli.-  precision  en  virgulc  fixe  et  la 
virgule  flottante.  La  preniEre  a ete  repoussec  car  : 

, (t)  le  nombre  de  m>'moire  inscriptible  nEcessaire  est  multiplie  par  deux, 

{?)  les  problemes  dr  cadrage  en  virgule  fixe  sont  considerables  dans  cettc  application, 

!,a  virgule  flrttant"  supprir.e  rad  ic.alement  la  contrainte  cadrage.  De  plus,  un  seul 
mot  sufrit  : 1-  bits  pour  la  mantissi.  plus  le  sigi-.e  et  3 bits  pour  I'exposant.  La  programma- 
t ion  d-s  op.'rat  ions  on  riottant  a Et-'  ires  soigneusement  optimisEe  et  conduit  a des  vites- 
e.rs  dr  calcul  suffisantos  peur  1 ’ expErimenta  t ion . I.es  performanc  e.s  ont  Ete  calculEes  pour 
un  V >1  typr  par  r-appori.  3 une  ar  itb.nEt  ique  flottantc  on  7c'  tits.  Les  rEsultats  montrent 
ur.r  infErieur.  ' ’ 1 . 


’ , . ■*  L'L'-iblii'Jl'CuL-'J'i-LCCL'iL'L’ 

E 7 ir-, ' !' u'  i i 1 ' ct.  sr:”,  at  i en  iJnpplrf,  on  cl'fectue  dc'ux  opEral  i ons-  : un  noyennage 

I'l  s i g.-.a  ! '.r  pour  dEPinir  I'u:  iimit.'S  de  validitE. 

‘ ' Z - I'l .C lie'll 

: -fp’.'-c  ar.-rs  fortrnmt  bruit-'  dans  l-'s  basses,  frequences,  i'our  ameliorcr  le 

r-'i;  r -sf  r ign  il  sue  ('riii’_,  on  a t’Eali:  ■'  un  moy-’iinage  sur  quatri-  srootuies.  I.e  retard  de 
s vr,f  I.'--  - cor.j  .'n.  •'  -ut  iat.a:.!  ! ' ■ ' . -u-vnt  ion  jui  miliou  de  la  peri.cde  de  moyeunago. 


■i'  i--,  lu  i fpl-T  'lEp.-nU  d,.  I'alt  itudr,  r)(>  a '.•.etie  s.ui'VolEr  et  I'tl 

■■  ! ' a.-.s  i avi-.n.  A la  1 ir.it>.  1 )•  i'oppii'r  decrectu',  c>iu'nd,ant  la  degra- 

r-a p r i . [’('ur  gar.aritir  le  rualEl,.  utilis.E,  dent  1<-  der.aine 

' i f r i '"I  s au  l■r.a^n>■  >1 'ut  i 1 is.,at  l"u  , il  >'S,t  i nd  i spensab  ' >’  de  deul  Irr 
!•'  r-  '■»  I.-  ■ o.  r;.,-  i|  ' ,a  ss  i •' !.  I ■■  I’t  d'interdil'e  lo  I'oppli'r  ;ni 
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2.^  , Miae  au  point  ctu  soft’^are 

Lea  difficultfia  • enoontrfioa  lora  do  la  miae  au  point  d'uri  programme  de  11000  mota 
sont  nombreuaea.  Lea  caractferlatiquea  du  diapoaitif  de  oalcul  utlliaS  pour  oette  experi- 
mentation tn  ajoutent  de  nouvellea  : memolre  A tambour,  fonctionnement  aaynchrone  dea 
calculeteura , dialogue  par  1 ' Intormediaire  d'un  regiatre  tampon  de  600  bita  et  program- 
mation  en  langage  machine. 

One  technique  de  progr'>mmation  modulaire  a et6  adoptfe  pour  faclliter  la  miae  au 
point  dea  orogrammea  et  leur  modification  Cventuelle'. 

Lea  fonctiona  rfaliafea  par  chaque  module  :iont  complexes,  lea  entries  et  sorties 
sont  mul t ivariablea . La  miae  au  point  n'eat  done  paa  simple. 

La  m^thode  de  test  utilisSe  est  clasaique  : on  compare  pour  une  excitation  carac- 
5^*'istique,  lea  rSponses  du  programme  du  oyat&me  rf*el  ct  d'une  simulation  en  langage 
ovolue  (voir  figure  5).  La  mise  au  point  a ^-tfi  faite  module  par  modulo  avec  des  entries 
simples  (Echelon),  puis  pour  I'ensemble  des  programmes  avec  dec  entries  correspondent  A 
la  simulation  d’un  vol  type.  L'Seriture  des  simulations  des  modules  sur  un  ordinateur 
puissant  (UNIVAC  1108)  a demand^  trois  mois  et  la  mise  au  point  des  programmes  rSels 
environ  deux  mois,  ce  qui  peut  etre  consid§r6  comme  rapide  pour  un  systSme  de  cette  taille 
et  de  cette  complexity. 


2.6  Essais  en  laboratolre 


Les  tests  precedents  permettent  de  controler  de  fagon  trAs  fine  le  software,  mais 
ne  verifient  en  rien  la  valeur  des  modelos  choisis  ni  du  filtre  utilise.  Cet  ultime 
objectif  est  le  but  des  essais  en  vol.  Cependont,  les  essais  en  vol  coutent  cher  et  sont 
difficiles  3 exploiter. ^11  ytait  done  souhaitable  de  pouvoir,  an  sol,  verifier  le  bon 
fonctionnement  et  memo  evaluer,  dans  certaineo  limites,  les  performances  de  I'ensemble 
de  1' instaHation. 

^ ^ Ln  methode  retenue  pour  les  essais  en  laboratoire  (V=0)  du  syst&me  complet  a consisto 
I etudief  la  reponse  flu  filtre  a des  Echelons  d'erreur  en  position,  d6rivo  et  factcur 
d'echelle  gyro,  et  biais  Doppler.  Les  resultats  obtenus  sont  pr6sent6s  sous  forme  de  cour- 


bes,  figures  92  13. 

r*  ■’rrf'ol  lot-  i 


L ' instal lat ion  a essayee  en  fonctionnement  "boucle  ouverte".  De  cette  fagon,  il 
fctait  en  effet  noss'ble  d'apprecier  les  performances  du  filtre  de  Kalman  programme  et 
3U3C  L de  le.j  comparer  3 cellos  du  .systilme  a inertie  seul. 


2 .0.1 

Les  figuroj  6 (a)  et  7 (a)  repreoentent , on  6cort  de  latitude  et  de  longitude, 

; erreur  do  position,  on  fonction  du  temps,  du  syst^mo  a inertie  seui.  L'echelle  des 
errours  n'-.st  pas  donr.oe  pour  des  raisons  do  classification. 

oos  Pigur-'-s  C (e)  et  V (o)  montront  les  ern'urs  apres  des  recalages  do  position 
.■•inplOo,  In  ontond  par  la,  uno  translation  ''le  la  position  de  la  valeur  du  vecteur  de  reca- 
lar.e,  au  r.iveau  de  I'afficbage  et  done  sanr,  ir.riucnce  nur  le.s  calculs  do  mecanisation  de 
la  p later-jrm.'. 

^Lr.  n (•]>  (d).  I (c).  '-t  7(d).  o:i  reprd-sonte  ler;  errea-a  de  positioi.  i’''s  idn^-’l- 

L-'.-,  pr,,.'.  . ri'-r-v:-;  r-'calaces  d'^  position  utili.si's  de  fagen  optimale  par  le  filtrf'  de 


•r',  i ••  -f  'vr  i:  1 r ni-  • ! ma  1 


s/jfitr"’:;’,  1-  ••rn-'-ar:'.  dn  system"  a inerllf.-  excite  par  une  derive 

‘ , T- ' •*''  ■'''  ‘ ‘‘".'■.i  nu'j  le;;  erreun:-.  re  s.  i due  H os.  npre.i  r i 1 1 ivag.' 

‘ uT’-il  , 'e.s,  1-.  Vine:-',  i'  et  d'-iri'-  eni  re.'  roppicr  nulle,  avec  pom-  sen'  l—iut 

’f'fit  in,  •le.-  c'l  ; •.•ril.;  r.'im-'ri'pie:-.. 

• ' "‘t'V  m''f'.’r'"  i"S  :"."ne;;  nar.am.'tr.'S  pour  un.;  ''Xrltali.in  d's  a in.-r- 

f ■ i ■ 'ii.  ■ !■  '■,•/.  1.:.  fin.'  r.'ilti.-  <■(,  p,,uf  n ti--  c.l  ns."' ..'V.-i  t i on  I'opjl'.'f  In-t;  i.in'e  pa!- 

n:.'  1'  ;nn;.  fian  'in  fr-'  I'l.-.'  .".  CiX'-. 
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?IGURt  5 - TEST  ET  MISE  AU  POINT  DES  MODULES  DE  PROGRAMME  DU  SYSTEMS  REEL 
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FIGURK  7 - INERTIE  RF.CALAGE  DF.  POSITION 


AG 


liii-.H'ni'  l'|•■/•A•.,A'iI■,  iiOl’l'i.KH 


5-19 


On  peut  coAiparer  sur  ces  courbea  ce  que  donne  I'inertle  pure  recalfie  classlquement 
(simple  translation)  par  opposition  au  couplage  optimal. 

Les  derives  sont  estimfies  correctement , les  oscillations  de  SchOler  sont  peu  amor- 
ties,  les  recalages  n'^tant  pas  assez  frequents. 

Cette  sSrie  de  vols  a ainsi  pu  valider  le  flltre  par  comparaison  des  performances 
obtenues  avee  les  courbes  obtenues  en  simulation  au  coura  de  I'fitude. 


3.  ALIONEMENT  RAPIDE  D*UNE  PLATEFORHE  A INERTIE 
5 . 1 G^n^ralit^s 

Cette  §tude  a 6t$  conduite  de  1972  197‘<  sous  contrat  de  la  Direction  des  Pecher- 

ches  et  Moyens  d'Essais. 

Le  but  de  I'Stude  ftait  de  valider  compl&tement  1 ' optimisation  d'un  alignement  do 
plateforme  sur  un  syst&me  3 inertie  r6el  en  tenant  compte  de  toutes  ses  caract§ristiques , 
Le  syst&me  choisi  ctait  une  plateforme  MOC  30,  de  la  famille  MGC  des  6quipements  SAGEM. 

L’objectif  fixS  Stait  de  r§duire  de  30  X la  durfie  totale  de  1 ' alignement . Les 
Etudes  thSoriques  ont  montrS  qu'une  reduction  de  *40  X pouvait  etre  obtenue,  r^sultat 
validf  par  1' experimentation  rSalisSe. 

On  connait  1' importance  de  I'alignement  initial  d'un  systSme  de  navigation  par 
inertie.  En  effet,  toute  err.eur  d'alignement  se  propage  (en  s'amplifiant  plus  ou  moins) 
comme  erreur  de  position,  de  vitesse  et  d’attitude  au  cours  de  la  navigation. 

L'alignement  initial  consiste  3 effectuer  les  opSrations  suivantes  : 

(1)  introduire  la  position  initiale, 

(2)  introduire  la  vitesse  initiale  par  ses  projections  sur  les  axes  calculateurs  [c], 

(3)  aligner  les  triSdres  plateforme  Ip]  et  calculateur  [c]  en  faisant  subir  une  rota- 
tion convenable  3 I'un  ou  3 I'autre  (§ventuellement  aux  deux  3 la  fois). 

L'alignement  peut  ?tre  r§alis§  de  fagon  externe  en  transf#rant  a la  plateforme  une 
orientation  connue  par  recopie  optique  et  mScanique. 

II  peut  etre  r€alis6  de  faqon  autonome  en  utilisant  les  instruments  de  la  plate- 
forme. II  s'agit  alors  de  I'alignement  par  gyrocompas  qui  nous  int#resse  pour  la  suite. 


5 . 2 Prineipes  d'alignement  et  modelisation  retenue 


3.2.1  Prineipes 


On  designe  par  J la  rotation  faisant  passer  de  1' orientation  d^siree  pour  la 
plateforme  (triedre  "vrai"  [v])  a 1 ' orientation  effective  de  la  plateforme  (triSdre  [p]). 
(voir  figure  1 3) . 


FIGUKE  13  - ALIGNEMENT  CLASSIQUE 


Oi  la  plateforme  est  par '’ai  tement  alignt-o  (i^i  r if  ^ ^ ^ z o),  les  signaux  accel6- 

rom»' t r iquer,  r.ont  : 


f,  = 0 
f,  = 0 
f’-)  = E 
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t't  lea  signaux  de  rnnmniuie  rica  gyrna  malntenarit  la  plaf'.e forme  alnat  alignSe  sont  : 

(•H  - n rod  L di) 

WJ  = 0 (I'O 

ujj  s fl  aln  I.  (1,)) 

!H'ux  approehea  permetterit  de  realiser  1 '.al  igtiemerit . 

(1)  I.e  point  de  vue  elaoalquo  eat  le  suivant.  L ' aligtiemenL  autonome  va  conslster 

.1  faire  un  toaclago  dea  Itistruments  (voir  figure  li)  tel  que  l'f;tat  caractfri  so 
par  (10)  3 (lb)  soit  le  seul  etat  d’Squilibre  stable  du  sysi.Sne  aitisi  realise.  On 

demande  en  plus  que  cot  etat  d ' oqui 1 ibre 

(a)  Suit  atteint  le  plus  rapidement  possible, 

(b)  ne  soit  paa  affeete  par  lea  divers  bruits  perturbant  le  systeme. 

Ces  deux  specifications  sont  contr-adictcires  et  ri6cessiteront  de  faire  un 
compromis  rapidite-precision. 


FIGURE  lU  - ALIGNEMENT  OPTIMAL 

Le  point  de  vue  optimal,  de  son  cote,  consiste  3 utiliser  des  modeles  statistiques 
des  divers  facteurs  aleatoiri-s  et  3 suivre  le  schema  de  la  fi;^ure  I'l. 

Les  observat  icns  f sont  filtrees  de  facjon  3 donner  la  meilleure  estimee  possitsle 
5 de  ? : la  platefcrme  est  alors  recalee  en  lui  faicant  effectuer  la  rotation 

-S'. 

Cet  alignement  est  optimal,  car  il  assure  3 cbaque  instant  la  moilleure  precision 
possible  pour  la  duree  ecoulee. 

ii!2il2li2§£i2D_r£  “SDyS 

■')  Afin  de  valider  au  mieux  la  methode,  on  n'a  pas  chercho  3 representor  par 
un  modSlo  le  transitoire  thermique  des  gyros,  1 'alignement  fin  commencant 
aprds  ctiauffage. 

En  ce  qui  concerne  les  derives  des  gyroscopes  E[  , F,?  et  E3  , on  suppose  done 
qu'ellcr.  sont  constantr-r,  pendant  1 ' al  ignement , nais  inconnuos  ; dies 
obeisaont  ainsi  au  modelf 

E 1 = 0 (Id 

E2  = 0 (IV ) 

F-3  = 0,  (18) 

av'-'’  line  moyenne  nulle  et  pour  ^cart-ty pen 


F,  ( E . ) : a ? 


5 = 1.  f.  3. 
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(2)  En  ce  qai  concerne  le  moddle  mathfimatique  repr§sentant  les  perturbations 
de  I'avion,  on  a cholsi 


- ”BCi  ♦ VI 


; . 1 r ^ r r 

C2  - Cl  - JT  Ca  - C3 


C3  - Ca 


M = masse  de  I'avion 

f = coefficient  d ' amortissement  visqueux 

k = raideur  rappelant  I'avion  S la  position  d'^quilibre 
(6lasticit§  des  pneus  et  des  trains). 

Cl  = force  perturbatrice  reprSsentant  I'effet  du  vent. 

Cette  force  eat  mod6lis6e  par  une  suite  d'Schelons  indSpendanta , d'amplitude 
al#atoire  sausaienne  centrSe,  de  variance  o^,  modifies  3 des  instants  dis- 
tribuSs  suivant  une  loi  de  Poisson  de  density  moyenne  B. 

La  modClisation  et  1 'estimation  des  mouvements  parasites  de  I'avion  impose 
une  frequence  de  calcul  §lev6e  compte-tenu  de  la  dynamique  de  I'avion  et  entraine 
done  une  charge  de  calcul  trds  importante  ; de  plus,  ce  mod&le  depend  du  type 
d'avion  sur  lequel  est  instance  la  plateforme. 

C'est  ce  modSle  qui  a 6t6  reteiiu  pour  la  simulation  dec  mouvements  avion. 

Par  contre,  pour  le  filtre  d'alignement,  la  simplification  Stant  nfoessaire,  on 
a choisi  un  bruit  blanc,  modSle  justifil  par  la  nature  allatoire  des  sollicita- 
tions  et  par  I'utilisation  d'une  frequence  de  calcul  en  pratique  plus  faible  que 
la  frequence  propre  avion. 

(3)  Si  I'on  prend  comme  vecteur  d'etat  : 

'*’2>  ‘<’3  1 El,  E2,  Ej) 

II  est  possible  de  voir  que  le  systSme  dynamique  ainsi  constitue  n'est  pas 
observable  3 partir  des  signaux  accelfrometriques  (voir  reference  [21]  par 
example) . 

On  est  ainsi  conduit  a intreduire  la  variable  ; 

»3  = '(’3  + E2  / n,  (23) 

et  les  composantes  Word  et  Verticale  En  et  Ez  de  la  derive,  la  composante 
Est  etant  inobservable  : 

Ejj  = El  cos  a - E2  sin  a (24) 

= E3  (25) 

Le  modele  est  alors  : 

Vi  - f-}  ^ sin  L + *3  R cos  L sin  a ♦ Ej^  cos  a (26) 

V2  =•'^1  R sin  L ♦ *3  R cos  L cos  a ~ sin  a (27) 

♦ 3 =-'(’1  R cos  L sin  a - '<’2  n cos  L cos  a + E^  (28) 

E,g  = 0 (29) 


E^  = 0 (30i 

Les  observations  - qui  sont  les  signaux  acc£-lerom6triques  - sont  alors  donnSes 
par  ; 


Vl  = - V,'^7  + Vi 


y;  - E ri  ^ Vj 


' ’it  fiv  wvipy 


oil  lea  Vi  aont  dea  bruita  blanca  et  non  le  moUSle  (20)  - (22)  ainai 
qu'il  a Itf  dlt  plua  haut. 


Lea  ai{;naux  aco5l6rom^ trlquea  arrivent  au  niveau  du  f litre,  aoua  forme 
d'impulaiona  dSllvreea  par  lea  intfgrateura  digitnux  d ' anc6l6ratlon  (IDA). 
Lea  regiatrea,  qul  oontlennent  ren  linpulBiona,  roprfiaentent  doa  valeura 
homogJnea  dea  vlteaaea.  Deux  poaaibllitea  sont  offerteo  •.  dfrlvor  lea 
Informations  pour  avoir  dea  obaervationa  dea  varlablea  d'ftat  ou  ajouter 
deux  variables  d'etat  et  conaerver.  cea  informations  comme  obaervationa. 
L'aiTlv4e  dea  impulaiona  en  provenance  dea  IDA  peut  avoir  une  fr6quence  du 
m?me  ordre  de  grandeur,  et  m?me  parfoia  heaucoup  plus  faible,  que  la  fre- 
quence de  caleul  (20  aeeondea  d'arc  d ' inc 1 inaison  plateforme  sur  un  axe 
gfn2re  I'art'ivee  d'une  impulsion  par  s oonde),  le  bruit  de  quantification 
est  done  importani.  et  il  faut  en  tenir  compte  dans  les  observations. 

Avee  le  vecteur  d’etat  : 

X'  = iri,  if2,  ♦i.  Rf,.  Rz' 

Les  Equations  (23)  .3  (27)  s'fcrivont  : 


X = 

Fx 

(3'0 

aveo 

r 

1 " 

n sin 

L n cos  L sin  a cos 

a 0 

- a sin  L 

0 

a cos  L cos  a -sin 

a 0 

P = 

- n cos  L sin  n 

-fi  coo 

L cos  0 0 

1 

(35) 

0 

0 

0 0 

0 

0 

0 

0 0 

0 

La  solution,  qui  consiste  S utiliser  les  sorties  aocumulees  dea  IDA,  Stant 
prlff-rable  3 celle  qui  utilise  un  algoritbme  de  derivation  (3  cause  du  bru 
de  quantification),  les  observations  s’ecrivent  ; 

.Vl 

= Z]  + V, 

(36) 

.V2 

: Z2  + V2 

(37) 

avti'c 

2l 

= -&'*z 

(38) 

Z2 

II 

(39) 

iuiit 

y - 

h z + V 

(i^n) 

t = 

Mx 

(in) 

V e c 

-1 

■l  O'] 

.0  ij 

(iJ?) 

"0  -g  0 0 ol 
.CO  0 0 oj 

('t3) 

tr'en.uit  1 v nouveau  vecl,'’i;r  d’ 

'•t.at 

X = 

:] 

('I'D 

M V I r'.  t. 

X = 

rx 

('<'.)) 

y = 

Xx  + V 

('t6) 

■ -j 

r- 

[::i 

r.;  .,] 
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I.»  solutlon^e  ce  syatdme,  obtenue  en  introdulsant  la  matrlce  de  tranaltion 
aaaooifie  ft  y , s'6crit  : 

X(t)  = *(t,  to)  X(to)  s *(t,  to)  Xo 
oil  la  matrlce  de  transition 

• eat  telle  que,»?^6tant  quasi  constant. 

♦ (t,o)  = \ * tT'  * — ^ ♦ . . . 

2 


( I + tr  + — 
2 

( tM  + ILmJ'2) 


x(t)  = *11  Xfl 


z(t)  = *21  XO 


car  zn  = 0 


Les  observations  s'lorivent  : 

y:hz  + v = l'.  *21Xo  + V = HXO  + V (53) 

avec  H = h(t)  »2i  (t)  (5^^) 

Sous  cette  forme  xq  devient  le  nouveau  vecteur  d'§tat,  que  I'on  va  cheroher 
.a  estimer  au  temps  t ; cette  mSthode  que  I'on  peut  appeler  "estimation  du 
vecteur  d'etat  initial",  se  resume  done  5 un  roodftle  de  la  forme 

xo(t)  = 0 (55) 

y(t)  = H(t)  Xo  + V (56) 

Au  cours  de  la  mise  au  point,  il  est  apparu  necessaire  de  calculer  la  matrice 
d'observation  H avec  une  approximation  du  troisi&me  ordre  pour  tenir  compte 
des  termes  qui  deviennent  si^nificatifs  au  bout  de  quelque  temps  d ' alignement , 
en  particulier  pour  I'estimation  dc  la  derive  du  gyroscope  d'azimut. 


3 . 3 Simulation  des  performances 

Le  programme  qui  permet  d'evaluer  les  performances  du  filtre  consiste  § integrer  la 
matrice  de  covariance  de  I'erreur  d ' estimation.  Pour  I'etude  de  sensibilitS,  on  a choisi 
une  duree  fixe  d'alignement  de  500  secondes  et  les  valeurs  typiquas  suivantes  ; 


(11  ecart  d ' hor izontale 

(2)  ecart  d'azimut 

(3)  derive  du  gyro  Nord 

(4)  derive  du  gyro  d'azimut 

(5)  pas  de  calcul 

(6)  bruit  sur  les  observations 


l',lo 
3°,  lo 

0,025  °/h,  lo 
0,1  °/h,  lo 
5 secondes 

_2  _ i 

10  ms  , lo 


Seules  sont  presentSes  les  erreurs  d'estimation  sur  *3,  Ejj  et  E- , car  les  estimees 
He  >fi  et  ^2  convergent  tres  rapidement. 

On  trouvera,  ci-apres,  1' ensemble  des  courbes  obtenues  en  faisant  varier  un  des 
param?;tres  (figures  15  3 20). 

F.n  resume,  on  pout  dire  quo  le  filtre  est  sensible 


(1)  a la  latitude  du  lieu  d'alignement 

(2)  au  Lruit  Sir  les  obuervations 
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(3)  la  durSe  du  paa  de  calcul, 
mala  qu'll  eat  Inaenaible 

(1)  H l'4oart  initial  d ' horlzontale , 

(2)  S I'Scart  initial  d'azlmut. 

T1  conviendra  done  d'optimiser  la  programmatl’on  pour  rfduire  la  dur6e  du  paa  de 
calcul,  et  d'ajuster  au  mieux  lo  bruit  blanc  sur  lea  obaervationa  qui  reprfaentc  lea 
perturbations  avion. 

On  choialt  pour  la  dur^e  de  I'allgnetnent  fin  225  necondea  qul  oorreapond  ft  line 
erreur  finale  de  cap  de  1,5  minute  d'nrc  et  0,0CS  ‘'/h  d'erreur  do  compenwatlon  de 
derive  rord,  pour  un  paa  de  1 aeeonde.  Duns  une  application  opi'ratlonnelle,  cette  durfe 
pourralt  5tre  d^finie  en  fonction  de  la  latitude  et  doublSe  d'un  test  d'fqulllbre. 


3.4  AlKorlthme  d'alignenient  gros 

L'alignement  groa  a pour  but  esseiitiel  de  degroasir  le  cap,  dans  I'hypothdse  oil 
I'on  n'a  aucune  information  de  cap  initial,  ceci  afin  de  pouvoir  appliquer  I'hypoth^se 
des  petits  angles  qui  eat  n^cesaaire  pour  pouvoir  linfariser  le  ayst?me  complet  de 
l'alignement  fin  avec  calibration  de  derive  du  gyro  Z. 

Get  alignement  gros  peut  de  plus  scrvir  de  base  a un  ’node  d'alignement  rapide  tole- 
rant une  certaine  degradation  des  performances  de  navigation. 

Pour  l'alignement  gros,  on  choisit  pendant  le  filtrage  : 

(1)  de  ne  rien  oommander  5 la  plateforme  en  verticale  car  son  orientation  §tant  incon- 
nue,  on  r.e  peut  compenser  la  rotation  torrcstre  de  fa?on  utile  et  bussi  parce  que 
de  cette  favon,  on  elimine  I'influence  de  la  sensibility  thermique  du  facteur 
d'echelle  des  gyros  de  verticale, 

(2)  de  compenser  on  azimut  la  rotation  terrestre  ce  quL  est  en  pratique  n6cossaire  pour 
linSariser  le  systime  comme  le  montrent  les  f-quations  ci-dessous. 

Pn  notation  matricielle  et  dans  le  rep^re  plateforme  Ip)  en  faisant  intervenir  les 
repJres  classiques  calculateur  (c)  et  geographique  local  fg],  :1  vient  [21)  : 


“c/i  ■ "^p/g  § 

(57) 

"’p/i  - + T . 

P g P/E 

E 

g 

(58) 

f = u)  / • ” u>  , . - 
p/i  c/l 

DP  P 

T / 

p/g 

( E -U ) + P 

z 

p;  g 

(59) 

Etant  donne  la  duree  t.’es  courte  de  l'alignement  gros  et  les  ordres  de  grandeur,  on 
peut  negliger  la  derive  gyro,  alors 


f - 

P 


p/g 


n + !2, 
g e" 


(150) 


'.'•inr!’'  -1 1 ’i*- f rorrr'’  ’'tant  ♦utalement  iricnmiu,  pour  ’ mp  1 i fi  >'r  on  a elioi:'-!  '.ii 

|cl  I.-  I.'l,  c t-.'i -dire 


m - o 
c 


<i>  -i  - a , 


Best  Available  Copy 


{f>n 


lt)2) 


:•>  a.  w 


La  rotation  qui  fait  paaaer  tp]  4 lol  fait  nlora  intervenir  deux  petits  anglea  yj 
et  t2  et  un  angle  quelconque  tj, 

Dans  cea  oondltlona,  lea  6quationa  qui  dficrivent  la  dynamique  de  la  plateforme 
deviennent  : 


s 15  ain  !•  - (5  ooa  L coa  *3 

= (5  ain  L fi  ♦ CDS  L ain  ♦$ 

♦ 3 ■ 0 

X5  = - coo  *3 
Xi,  = sin  *3 

'fi  = a sin  L f2  ♦ f!  '203  L X5 
'fj  - -a  sin  L + n cos  L Xi, 

X4=  0 
Xs=  0 

L’estimat ion  de  I'angle  Op  o'obtient  alors  par  ; 

a = Arc  Tg 

-Xs 


En  posant 


On  obtient 


(63) 

(6<0 

(65) 

(66) 

(67) 

(68) 

(69) 

(70) 

(71) 

(72) 


L'avantago  de  cette  approche  est  que  le  filtre  a la  meme  structure  que  celui  de 
1 ' alignement  fin,  la  matrice  K #tant  ; 


P = 


-n  sin  L 
0 
0 
0 


n sin  L 
0 
0 
0 
0 


n cos  L 
0 
0 
0 


n cos  L 
0 
0 
0 
0 


(73) 


3 . 5 Organisation  du  programnie 

3.5.1 


Le  choix  entre  1 ' ar  ithmerique  en  virgule  fixe  et  I'arithmetique  on  virgule  flot- 
tante,  eat  dans  le  cas  de  cettc  experimentation  un  problSme  tr&s  important,  car  le  calcu- 
lateur  associe  a la  plateforme  inertielle  ne  dispose  d'aucune  instruction  qui  permette 
inpletnent  la  programmation  de  la  virgule  flottante.  Apr6s  une  rapide  etude  de  faisabilite, 
00  simulation::  ont  permis  de  verifier  que  les  calculs  en  virgule  flottante  pourraient 
-tre  conduits  en  prenant  un  mot  de  I6  bits  pour  la  mantisse  et  un  mot  de  I6  bits  pour 
1 ' exp(-sant  ce  qui  conduit  2 des  precisions  numeriques  satisfaisantes  et  A un  pas  de  cal- 
cul  de  I'ordre  de  1 soconde.  Ler  figures  21  et  22  prfsentent  les  courbes  obtenues  3 
partir  !*•  cimulatior.s  avcc  le  DASH  (voir  section  U.2)  dans  le  cas  de  I'algorithme  d'ali- 
gnf'n-'Tit  gros  utilisant  le  flottant  Ilnivac  (C<t  bits  de  mantisse)  ou  le  flottant  UTD  simule. 
'..‘■c,  sauts  qui  anparalssent  correspondent  aux  perturbations  aleatoires  avion  simulees  dans 
If  LA3H  oonformer.ent  au  modOle  (20)  a (22). 


' ; 5 . 2 Peca lage_de_  Ka_glatefgrme 


A chaque  fin  de  phase  de  1 ’alignement , on  dispose  de  I'estimee  dc  I'erreur  d'hori- 
zonta'Lte,  et  de  I'estimee  dc  a.  Les  taux  de  commando  3 appliquer  aux  gyroscopes  sc  d6com- 
per^ent  'T,  d'"jx  t--rT.es  : 


;i)  ire-  pnr’  ie  pour  In  compensation  ue  la  rotation  terrestre,  ce  tcrme  restcra  constant 
„..-qu''i  uri<-  pr-ochaine  estimatioti  de  a, 

' iir  - p-ir-t  if  [o-ir-  r'l  f t rape’-  1 ' lior  i zontal  i t*' , ce  terme  dcvnnant  nu  1 apres  la  phase  dc 
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(1)  le  programmo  clasaique  d'alignement  de  la  plateforme  inertielle  MOC  30 
utilisSe  pour  1 ' experimentation , ae  deroule  de  la  facjon  suivante  : 

(a)  chauffago  rapiUe  de  Ja  plateforme  et  oalage  de  la  plateforme  sur  le 
zero  des  resolvers  dc  chacun  des  axes. 

Cette  phase  dure  au  minimum-  136  seoondes  ; la  phase  suivante 
s’enchalne  si  cette  condition  de  temps  est  realisSe  et  si  le  chauf- 
fage  rapide  est  termini. 

(b)  calage  analogique  rapide, 

De  duree  8 secondes,  cette  phase  consistc  S asservir  I'accelerometre 
au  zero  de  son  dStecteur,  en  faisant  preoessionner  les  gyroscopes. 

(c)  alignement  digital  grossier. 

Duree  190  secondes,  ce  premier  filtre  digital  permet  d'aborder 
I'alignement  fin  svec  de  bonnes  conditions  initiales. 

(d)  alignement  digital  fin. 

Duree  672  secondes,  ce  filtre  ne  diffSre  du  precedent  que  par  des 
changements  de  gains. 

(el  test  de  stabilite. 


Duree  25  secondes 
(f)  Ready  Nav. 

La  plateforme  est  alignSe,  le  status  indique  aiors  l'estim6e  do  la 
composante  Nord  des  dirives  des  gyroscopes. 

(2)  Le  programme  d'alignement  optimal  comporte  les  deux  premieres  phases  (a) 
et  (b)  puis  : 

(o)  alignement  digital  grossier  de  durie  80  secondes 

(d)  un  recalage  de  la  plateforme,  dont  la  dur§e  est  infSrieur  S 10  seoon- 
des (ce  qui  correspond  5 20  minutes  d'arc  d ' inclinaison  i rattraper). 

(e)  un  alignement  digital  fin  do  duree  225  secondes 

(f)  un  recalage  de  la  plateforme  cie  dur§e  inf^rieure  5 la  sooonde. 

Les  temps  compares  des  deux  methodes  ronduisent  3 : 

alignement  classique  1031  secondes  = 17  minutes 

alignement  optimal  450  secondes  = 7,5  minutes 


!;2E29lLri5li9y£S_du_Drogramme 


'J  'j 


La  snr.plification  de  la  prcgrammation  etant  un  souci  constant,  des  programmes 
rnux  nui  pernettent  la  manipulation  des  matrices  ont  ete  developpes.  La  contrainte 
calcul  etant  tres  importante  dans  ce  problems,  nous  avons  ete  amenes  a opti- 
r ..'■‘s  traitemcnts,  en  testant  par  exemple,  la  nullite  des  operandes  pour  ri'offectuer 
iss  ype rat. ions  recessaires . 


nc t ue i.  j. emen t , 1 -■  d-jree  du  pas  de  calcul  en  alignement  gros 
! socor.de  ; en  soignant  la  prcgrammation,  on  pourrait  ohten 
et  0,75  sec  ndfs,  mais  le  cout  de  la  programmat ion  est 
t‘-  non  e.iooro  demontree. 


et  en  alignement  fin 
respectivement 
non  riegligeable  et  la 


r,r'  voliimo  momoire  utilise  p 
iro'nf:nt  implarite.s  en  memoirs 
t,-'no  ire-. 


our  realicer  co  filtre  est  cie  l8cn  mots  dont 
v've  ; la  encore,  no\ir,  n' avons  pa."  optimise 


550  mots 
1 ' encom- 


je'r-.  j ! tats  de  L ' exp&r imentat  ion 


-1  1 i d ! t d 
1 t .at:', 
'■I  VdC  ',0, 


1 alignement  optimal  programme  sur  la  Mr.C  50  a ete  etablie  par 
nttenu:-.^en  l.ahoratoirs  avec  cot  alignement  et  nvec  I'alignement 
le  :;y:;teme  »'tant  cnaud  initiaioment  dans  ion  deux  ca.". . 


compa- 
c 1 ii  r>  ** 


'i  'Mr 


rn> 


'H'  r.V  t.  n;i  i>rif  t.'  y 
'r,  t r:r;  -'(,u  i 1 i hr"'  f 


Best  Avi 


i:-,-'  par  cel 

inril  siippo;-. 

— . ■ 1 I 

■»-%  h '6,^  a*.. I 


|e  de 
e lltU' 


I'et.at  d ' eqii  i 1 i bpf'  Ue  la 
tii'nne  Verticals,  un  ton  cap 
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3 

i 

et  une  bonne  compensation  des  dSrivfis  gyros.  i 

I 

Deux  types  de  verifications  ont  etS  faits  : ■; 

(1)  un  contrCle  global  d'Squilibre  i 

1 

(2)  un  contrdle  de  la  mesure  du  nord  | 

3.6.1  ContrSle  global  d'^quilibre  -j 

i 

Les  enregistrements  presentSs  sur  les  figures  2k,  25  et  26  permettent  de  comparer  » 

les  deux  mSthodes.  Ils  reprSsentent  les  sorties  analogiques  ox^et  oy  des  boucles  acceiSro-  | 

mStriques  en  fonction  du  temps,  aprSs  I'alignement.  Ils  caracterisent  done  bien  I'^quili-  ? 

bre  et  montrtnt  des  dSrives  residuelles  globales  de  la  plateforme,  inf§rieures  a 0,01  °/h  \ 

dans  les  deux  cas,  pour  les  temps  d'alignement  de  1031  secondes  en  classique  et  ^50  secon- 
des  en  optimal. 

3.6.2  Controle  de  la  mesure  du  Nord 

Les  rSsultats  du  systSme  ont  StS  oontrSlSs  par  des  mesures  directes  de  I'erreur  ' 

du  Nord . ; 

, . . . 'I 

Les  angles  qui  interviennent  dans  les  difffirents  calculs  sont  definis  ci-dessous.  i 


FIGURE  23  - CONTROLE  DE  LA  MESURE  DU  NORD 


Le  boitier  plate-forme  est  monte  sur  un  plateau  diviseur.  Son  orientation  A par 
rapport  au  Nord  est  done  lue  directement  ; la  precision  sur  la  connaissance  du  Nord  est 
approximativement  2 minutes  a 'arc,  mais  ce  qui  importe  est  que  A soif  constant. 

(1)  'f  angle  entre  I'axe  du  gyroscope  Gjj  et  le  boltier  est  mesure  avec  une  pre- 
cision de  0,1  minute  d’arc  mais  I'axe  electrique  boitier  peut  differer  par 
I'angle  B de  I'axe  mecanique.  Cet  angle  est  constant  et  correspond  a 
I'erreur  de  calago  du  resolver  d'azimut. 

(2)  S,  estimee  de  a,  est  donnfie  avec  une  r&solution  de  0,1  minute  d'arc. 
[,'erreur  do  = 5 - a s 'exprime  par  la  relation 

do  = ot  + l'  + B + A (/^) 


AvqiIsIdIq  Copy 


Phise 

1 

Caging 

Ph»$e 

2 

Calage  Analogique 

Ph,»sf 

3 

Alignement  Cros 

Phast 

4 

Recalage  Piate-Fomw 

Phase 

b 

Allgnenent  Fin 

Phase 

£ 
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7 

Navigation 

% 
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Une  prerai6re  s6rie  de  33  easals,  a permis  d'fivaluer  I'alignement  olasaique, 
aur  la  connaiaaance  de  a,  Loa  r^aultata  aont  lea  aulvanta  ; 


0^  = 7.8’ 

"s  ' 9.6' 

D'autr«!  part,  21  eaaaia  d’alignement  optimal  ont  donn§  pour  rfiaultata  : 


= 7.2’ 


c-  = 9.7’ 


“da  = 5.7’ 


Ces  deux  afiries  d'essaia  donnent  done  des  rSaultats  comparables. 


l*.  CONSIDERATION  SUR  L’INOENIERIE  DES  PILTRES 
A . 1 H^thodologie  ggn^rale 

Une  mSthode  d'eatimation  recursive  d'un  param&tre  A partir  d ' observations 
est  de  la  forme  : 


^n  ■ ^ ^^n-1’ 


yp) 


(75) 


oil  x^  est  la  meilleure  estimSe  de  x compte  tenu  des  observations  yj,  y^  , ...»  y^^. 

La  formula  est  dite  rSoursive  car  la  nouvelle  estimie  51  est  fonction  seulement 
de  I'observation  pr^sente  yn  et  de  I'ancienne  estimee  5ln-i,  et  ne  fait  pas  intervenir 
explicitement  lea  anciennes  observations  yn-i,  Vn-a**'  On  voit  immSdiatement  combien  une 
telle  formule  est  adapt#e  au  calcul  numSrique  en  temps  r6el. 

R.E.  Kalman  [51  a montre  qu'il  existe  des  formules  d’estimation  recursives  lineaires 
si  I'on  cherche  A estimer  un  processus  gaussien-markovien  x(t)  5 partir  d ' observations  y 
dependant  lin§airement  de  x et  eventuellement  bruitSes  par  un  bruit  blanc.  II  s'agit  done 
de  donner  une  telle  representation  markovienne  au  problime  pos§. 

Lorsque  le  module  est  obtenu,  il  convient  de  simuler  les  performances  du  systeme 
optimal.  Cette  simulation  consiste  essentiellement  8 integrer  I'iquation  de  Riccati  du 
filtre  optimal  qui  donne  ?a  covariance  des  erreurs  d'estimation  et  par  consequent  les 
performances  du  systSmo  optimal. 

Dans  la  realite  cependant,  le  modlle  mathematique  n'est  pas  connu  parfaitement . Le 
probieme  pratique  important  est  celui  de  la  sensibilite  du  filtre  : quelles  degradations 
de  performances  sont  entralnees  par  la  mauvaise  adaptation  du  filtre  aux  lois  statistiques 
des  paramStres  traites  ? Suivant  les  cas,  les  effets  peuvent  etre  faibles  ou  au  contraire 
desastreux. 


Enfin,  la  programmation  du  filtre  peut  poser  certains  probiemes.  Le  filtre  optimal 
consiste  essentiellement  a integrer  I'equation  de  Riccati  en  meme  temps  que  I'equation 
generant  la  meilleure  estimee  5E(t)  de  x(t). 

II  se  peut  que  le  volume  de  calcul  correspondent  soit  trop  important  et  que  I'on 
envisage  une  simplication  des  calculs  par  omission  des  termes  qui  semblent  insignif iants 
ou  par  d'autres  methodes.  II  convient  dans  ce  cas  de  controler  les  degradations  de  per- 
formances correspondant  8 ces  simplifications. 

Enfin,  la  programmation  et  la  mise  au  point  d'un  programme  qui  peut  faire  quelques 
milliers  d ' instructions , ne  sont  toujours  aisSes.  II  est  nScessaire  de  faire  appel  3 des 
methodes  de  test  evoluees,  d'autant  plus  que  la  fiabilite  recherchfie  est  grande. 

La  demarche  qui  vient  d'etre  decrite  pour  la  conception  d'un  systdme  de  traitement 
optimal  d’ informations  est  r^sumee  par  1' organigramme  de  la  figure  27.  Dans  la  section 
U.2  nous  avonn  choisi  de  presenter  une  m£*thode  de  test  et  de  mise  au  point  de  programmes 
de  riltrage  developpee  par  SAGEM,  renvoyant  aux  rSffirences  pour  les  autres  points. 


Interessant  ? 



' 

autre 

V cnose 

Sensibilite  aux  parametres 
mal  connus 


Conslruire , programmer 
et  tester  le  systeme 
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4 , 2 Dispositir  d'Aide  8 la  rrogrnmmation  dt»3  Syatdmes  Hybrldea  (DASH) 

^,2.1  L'outil  DASH  permet  de  mettre  au  point  et  de  contrSler  le  lot^jciel  des  systSmes 
hybnider . 

En  effet,  le  dSveloppement  aur  oalculateur  embarqu6,  des  programmes  de  filtrage 
§volu§3  (KALMAN),  de  systSmes  hybrides  eat  une  op6ration  difficile  qui  conduit  en  parti- 
culier  3 la  simulation  des  performances  du  systSme  envisage,  3 des  mises  au  point  labo- 
rieuses,  et  qui  pose,  d'une  mani^re  gSnfrale,  le  probl3me  de  la  qualification  des  pro- 
grammes. 


Les  principales  causes  de  ces  difficultes  sont  : 

(1)  le  manque  de  periph§rique  evoluSs, 

(2)  le  manque  de  software  d'aide  3 la  programmation. 

AprSs  la  pSriode  de  mise  au  point,  les  essais  "en  vraie  grandeur"  apportent  des 
informations  qu'il  faut  analyser  ; un  mauvais  fonctionnement  peut  provenir  ; 

(1)  d'erreurs  de  principe, 

(2)  d'erreurs  de  programmation  non  dStect§es, 

(3)  d’une  mauvaise  adaptation  du  filtre  due  ; 

(a)  3 des  erreurs  de  modele 

(b)  3 une  sensibilite  trop  grande 

Pour  resoudre  ces  problemes  d'etude,  de  mise  au  point  et  d ' exploitation  d'essais 
en  vol  et  de  leur  bonne  utilisation,  I'expirience  des  systSmes  hybrides  a conduit  la 
SAGEM  3 ddvelopper  une  mSthodologie  g§n$rale  basde  sur  I'utilisation  des  ressources  d'uti 
ordinateur  ; les  deux  grands  objectifs  6tant  de  disposer  (voir  figure  28)  : 

(1)  d'une  simulation  la  plus  r§aliste  possible  pour  effectuer  l'§tude,  la  mise 
au  point  du  filtre  et  de  sa  programmation, 

(2)  .-d'un  proc#de  d ' enregistrement  qui  permette  de  "rejouer"  un  vol  simule  ou 

reel,  soit  3 travers  le  filtre  programme  sur  le  oalculateur  embarqu§,  soit 
a travers  le  filtre  theorique  programme  sur  ordinateur  du  centre  de  calcul. 

Pour  une  application  donn§e,  une  fois  l'6tude  de  definition  r§alis§e,  I'utilisa- 
tion pratique  des  outils  de  cette  mithodologie  se  situe  3 trois  niveaux  : 

(1)  simulation  sur  ordinateur,  qui  permet  : 

(a)  de  verifier  la  validite  des  Squations, 

(b)  de  demontrer  les  performances  pour  des  trajectoires  de  vol  typiques, 

(c)  d'etudier  la  sensibility  du  filtre. 

(2)  programmation  du  filtre  ainsi  defini  sur  le  calculateur  embarque  et  mise  au 
point  en  utilisant  les  trajectoires  simulees  et  enregistrees  sur  bandes  et 
on  '’omparant  les  resultats  a'^ec  ceux  obtenus  sur  ordinateur, 

(3)  essais  en  vol  avec  enregistrement  des  sorties  des  senseurs  et  des  resul- 
tats du  filtre . 

Si  les  performances  ne  sont  pas  suffisantes,  les  enregistrements  en  vol  sont 
utilises  au  centre  de  calcul  pour  controler  les  resultats  et  definir  les  modifications  a 
realir.er. 


De  plus,  dans  le  cadre  d'une  production  en  serie  de  systemes  hybrides,  cet  outil 
rout  servir  a la  realisation  des  essais  de  recette  au  sol  par  controle  des  resultats 
obtenus  cur  une  trajectoire  type. 

Le  developpement  de  cet  ensemble  d'aide  a la  programmation  des  systemes  hybrides 
oor.[;or’te  celui  : 

( ) d'un  ensemble  de  modules  de  programmes  sur  ordinateur, 

(?)  d'equipemcnt  d ' enregistrement  compatible  pour  utilisation  au  sol  et  en  vol. 

’ D<’  facon  plu.o  preciso^  Ip  mini -ordinateur  utilise  par  le  DASH  recree  I'environne- 

I',  -a  1 labour,  par  oxomfile  .•'.imule  une  pla.teforme  inertielle,  un  OMEGA,  un  Doppler, 


Best  Available  Copy 


Parametres 

pour 

DASH  22 


des  senseurs 


Colculoteur  du  systeme  embarqu^ 


Trajectoire 


5-41 


la  validation  du  U'glolel  n*»rf»olu#i  Hit  tpols  l.ampfl  ! 

(1)  i ’ al>orat, ton  d'una  trajectoirt*  dw  rfir<^r«no«  (DASH  SI),  voir  figure  29. 

(^)  ijlaboratlon  de  la  trajeotolpe  rnatituArt  par  le  oaloulateur  embarquf  (DASH  22), 

voir  figure  30. 

(3)  comparalaon  des  trajectoire«. 


5.  CONCLUSION 

Nous  avons  prSsentS  deux  experimentations  concluantea  et  la  mSthodologie  d6veloppet- 
pour  realiaer  des  filtres  de  navigation. 

II  est  clair  aujourdMiul  quo  la  methode  de  ayntH&ae  de  filtres  de  Kalman  est  devenue 
"classique".  La  plupart  des  dlfricultfs  do  realisation  ont  et6  surmoriteo.s . 

Restent  A pr^voir  des  amSl  iorat  Lons  ou  des  fvolutlons  do  techriiquo  sur  au  moir.s  deux 
points  : 

(1)  les  m^thodes  d* identi ficat ion  des  erreurs  instrumentnlea , utilisfes  3 uc  jour  sent 
souvent  lourdea  ot  couteunes  ; des  filtres  prfsentant  certains  caractAres  d'adupta- 
tivite  seraient  les  bienvenus  et  sont  en  coura  d'etude  dans  quelques  centres, 

(2)  les  nethodes  d’^-tat  p.*rmettent  non  seiilement  de  faire  la  syrithAse  de  fillrer.  opti- 
maux,  mais  aunsi  de  filtres  mimeriouer  extrenenent  simf-les,  efficaces  et  l)un  marche; 
de  nouveaux  systJmes  de  navigation  et  de  pilotage  automatique  utilisant  ces  filtres 
verront  le  jour  dans  un  proche  avenir. 
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A SHIP  TRACKIhG  SYSTEM  USING  A <AtMAN-SCKHIOT  FILTER 
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SUfflARY 

This  paper  describes  the  digital  processing  of  reasurements  at  a high  accuracy  shlp-tiacking 
system.  The  errors  affecting  the  azimuth  measurement  supplleo  by  the  measuring  device  of  the  ground-ba'Ed 
station  are  found  to  be  the  most  critical  for  the  overall  accuracy  of  the  system.  A Kalman-Schmidt  filter 
Is  selected  for  an  opLInum  estimation  of  the  azimuth  speed,  folljulng  comparisons  with  a Kalman  filter  and 
an  "averagel hg"  filter.  The  estimation  of  the  navigation  parameter;  Is  destrlbed  and  the  position  and 
speed  accuracy  acnieved  by  the  system  Is  calculated.  Moreover,  various  effects  resulting  frem  the  data 
processing  in  a computer  are  analyzed  and  optimized  ; for  Instance  choice  of  the  computation  rate  for  the 
azimuth  velocity,  scaling  of  navigation  parameters,  etc..;  finally,  the  progi'annlng  of  the  dita  processing 
1n  a microcomputer  1;  described  and  evaluated  from  two  standpoints  ; menrory  space  requiremeu'.  and  comnu- 
tation  time.  The  results  obtained  confirm  the  etficiency  of  the  solutions  selected. 


1. 

M 


GENERALITIES 


Purpose  and  Description  of  the  Sh  ■*  o Trackino  Sysrpm  (STSJ 


The  purpose  of  the  Ship  Tracking  System  destcTed  by  "LabO’  atol re.  Central  de  TelAcomtruril cations " 
Is  to  provide  the  pilots  of  I’rge  tanker-harbours  with  a synthetic  aid  to  navigation  in  approach  channels. 

The  data  supplied  to  a ship  pilot  by  the  Si'S  are  (Figure  1) 

(1)  The  position  and  speed  of  the  ship  along  the  channel. 

(2)  Its  deviation  from  the  Imaginary  axis  of  the  channel,  as  well  as  Its  deviation  speed. 

With  these  ends  In  view,  the  ST'  processes  tne  range  and  a’lnuth  data  provided  by  a radio  fre- 
quency measuring  device  located  on  the  shore,  at,  at  a high  altitude  point  In  the  vinicity  of  the  harbour. 


The  data  are  processed  optimally  (as  will  be  specified  later  on),  In  the  computer  of  the  ground- 
based  station  In  which  the  measuring  device  Is  located  and  then,  sent  to  the  ship. 


;.2. 


Naviuatipn  in  the  charine! 

■ srVaaa^as  ■ •aa«aa  Ws  s 


The  channel  1s  considered  as  a seoucnce  of  segments  smalle,  and  smaller  as  the  ship  goes  to  the 
shore.  Moreover,  In  the  terminal  area,  the  pilot  caii  choo'e  between  several  manoeuver;  (anchoring,  choice  of 
a wharf,  etc.  . . ) . 

In  the  case  which  Is  to  be  considered  here,  some  specific  points  In  the  channel  are  taken  as  re- 
ference ; They  are  respectively  33  km,  22  km,  15  km,  12  km  and  4 km  for  from  the  ground-based  station. 

1.3.1.  Ra  t.4.  I TP!!'.  PI'  ®.  PIPIIIslPlPlPI.  SPUPPPIP.  PP.  Pll.  PPIPP  '■‘.’'I 

The  datj  transmitted  to  the  pilot  when  the  ship  Is  located  betweeti  point  »,  and  point  x.  . are 
as  fol lows : ’ ' ^ ‘ 

(1)  Manoeuver  number  (phase). 

(2)  Segment  number  (segment  x^^j). 

(3)  e = distance  from  bridge  renter  to  segment  x^ 

0 

(4)  e = derivative  of  e with  respect  to  t. 

(5)  L ' distance  from  bridge  center  to  point  x^^j. 

(6)  L • derivative  of  L with  respect  to  t. 

(7)  Status  (Information  ori  tnt  system). 
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1.3.2  compute'* 

The  above  data  are  transmitted  back  to  the  grotiid-based  station  via  the  responder  in  order  to 
ensure  a reasonably  good  reliability  of  the  tr.ansmisslon. 

Besides,  during  phases  where  a choice  is  necessary,  the  pilot  chooses  his  option.  The  instruction 
is  then  relayed  to  the  ground-based  station  by  pressing  a specific  key. 

2.  PRELIMINARY  STUDIES 

The  accuracy  and  rate  of  display  of  the  navigation  parameters  selected  are  given  in  the  table 
below;  they  result  from  o study  car'-ied  out  previously  at  LCT. 


Displayed  vali*e 

Rate 

Accuracy 

L 

1 s 

i 20  ffl 

1 t 

From  33  km  to  12  km  : t .30  m 

1 

Oelow  12  km  : 1 10  m 

1 » 

L 

5 s 

From  33  km  to  12  km  : ♦ 12,5  cm/s 

Below  12  Icm  : + 7.  5 cm/s 

e 

5 S 

From  33  km  to  12  km  : •*  12.  5 cm/s 

1 



Below  12  km  : t 7.  5 cm/s 

■ 



2-2  iB4kllU9LJIL!iEJ2CI 

The  oseas'jring  device  used  by  tlie  STS  provides  the  range  and  atimuth,  in  relation  to  the  grounri- 
uased  station,  of  the  radio  frequency  -"espondcr  pieced  on  the  ship  b;idge.  The  errors  for  which  it  is 
responsible  are: 

(1)  Approximation  errors  such  as  systematic  errors  resulting  from  the  curvature  of  the  Earth 
and  the  parallax  effect. 

(2)  Measurement  errors  resulting  from  radio  frequency  noise  in  the  receiver.  Such  errors  are 
to  be  found  both  in  tte  range  and  azlm-ith  chantiels. 

(3)  Disturbances  due  to  non-zero  accelerations  on  the  ship. 

2.2. 1 

(1)  Earth  curvature  effect;-  The  measurement  carried  out  by  the  ground-based  station  is  the 
straight  line  dist-rce  from  this  statior.  to  the  ctiip  responder.  Assuming  that  there  is  no 
parallax  effect,  the  error  made  at  a distance  of  40  km  is  approximately  10  cm. 

(2)  Parallax  effect:-  If  we  assume  that  the  Earth  is  plane  and  if  we  take  Into  accouiil  the  fact 
that  the  responder  is  at  least  at  20  m above  sea-level,  whereas  the  station  is  at  an  a’ti- 
tude  of  100  m,  the  error  a'^fecting  the  range  measuremerit  is  1.4  m over  a distance  of  2 km; 
this  error  d-.i.. --ases  very  rapidly  as  the  distance  increase:#  and,  in  any  case,  can  re  dis- 
regarded in  comparison  with  the  other  errois. 

r.2.2  Measurement  errors 


(1)  Range  Tracking  Loop:-  The  range  tracking  is  pern.jrined  by  mean--  of  a mobile  detection  window 
located  at  the  receiver  ootput  and  generace-d  by  a pu’se  genorator  synchronized  with  that  of 
the  transmitter.  Tl.e  pulse  frequency  or  the  win/jow  is  tuned  up  until  1,.  coincides  exactly 
with  the  pulse  sent  back  by  the  rcjp.'rder;  The  servo  loop  which  arhi“ves  c.:is  automatic 
tuning  is  called  a range  tracking  loop,  it  is  demonstrated  thac  the  range  tracking  ’eno  can 
be  representeo  by  the  tig.  2; 
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order 


Figure  2:  Range  tracking  loop. 

The  values  represented  are: 

true  position  of  the  ship 

position  white  noise  induced  by  radio  frequency  nolsu 
measured  distance  error 
voltage  passing  trough  the  window 
control  voltage  of  the  pulse  generator 

difference  1.i  phase  betwe.-n  the  window  and  the  emitted  pulse 
0^  • distance  measureo  (prior  tn  quantization) 

0 • quantized  aieasured  distance  (2  m quantum) 

The  control  looo  compensation  is  chosen  sc  that  the  closed  loop  transfer  function  be  of  the  second 

VP) 

■ -r 


eo(t' 

t>o(t) 

aD(t) 

V 

''l 

a* 


+ 2 


t 2 Cui^o  ♦ P 


which  enables  1t  to  recover  the  target  in  the  case  of  a temporary  signal  loss. 

In  order  to  ensure  a satisfactory  operation  of  the  overall  tneasu-ring  system  both  for  acquisition 
and  tracking,  tne  parameters  of  the  range-tracking  loop  are  set  in  such  a way  as  to  ensure  that  the  damping 
ratio  ; = 1. 

The  value  selected  for  is  0.302  rad/s;  for  a ratio  S/8  = 20  dil,  obtained  for  0 33  km,  it 

ensures  a standard  deviation  Op  of^O.55  m aio.vj  the  distance. 


Ar,  Op  Is  given  by 


Wp  being  the  energy  level  of  the  white  noise  bp{t),  we  easily  derive  W,j  = l.nj  m'^/s. 

When  the  distances  are  smaller,  Wp  decreases,  and,  therefore,  the  lowest  accuracy  is  to  be  lound 
at  33  km.  This  'tatcmenc  will  be  proved  later. 

(2)  Azimuth  angle  traul'.ing  loop:-  The  azimuth  tracking  loop,  whose  operation  will  not  be  det- 
crioed  m detail  here,  can  also  be  represented  by  a ?nd  orde.-  transfer  function,  whose 
damping  c Is  !■  Ihe  noises  generated  by  the  loop  proper  are  neg’igible  as  compared  tc  radio 
frequency  noises. 

The  closed- loop  transfer  function  is 


Vp) 


* 2 Cipp 


-0  * 2 P"QP  * P' 


1 and  (Up  * 2.23  rad./s. 


Fur  vaiinus  values  of  the  distance  between  the  ship  and  the  ground-based  station,  the  taule  hereafter 
dives  the  values  of  C/Mj  of  the  angular  error  standard  deviation  oy,.  the  energy  level  of  angular  white 

noise,  expressed  In  rad  /s,  and  W',  the  corrcspondl  ng  energy  lovtl  expressed  tn  ni‘/s. 
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2.2. 3 Acceleration  disturbances 


Apart  froir.  the  above  errors,  seme  disturbances  affect  the  accuracy  of  the  STS.  Taking  into  account 
the  choice  which  will  be  made  for  the  estimator,  such  disturbances  can  be  regarded  as  amounting  to  the  ship 
accelerations. 

If  the  ship  is  assumed  to  be  moving  with  a constant  acceleration  during  an  estimation  period  -which 
wi'l  be  shown  later-  the  only  statistical  knowledge  of  the  magnitude  of  the  ship  accelerations  is  sufficient 

As  a result  of  simulations  car. led  out  at  LCT . it  has  been  possible  to  quantify  the  maximum  longi- 
tudinal and  lateral  accelerations  of  the  sliip  changing  Its  heading 

(i)  Lateral  accelera t Ions : - r ig,  3 shows  the  form  of  the  response,  obtained  on  the  lateral 
speed  V , for  a 193,000  i.  3C0  mlong.  the  csso  Bernicia",  after  a 1U°  heading 
change.  The  shiji  was  assumed  to  be  equiped  with  an  automatic  pilot  of  the  PD  type  with  a 
lead  of  29  c , and  the  rotation  speed  of  the  helm  was  limited  to  2.£°/s. 

d V 

The  highest  values  determined  for  the  lateral  accelerations  ^ are 

iTf)  » 10'^  m/s^ 

max 

In  pract'-ce.  however,  fwo  phenomena  have  to  be  taken  into  acccu.-'t: 

(a)  At  a constant  speed,  the  maximum  accelerations  mentioned  above  .'re  proportional  to 
the  turn.  Now,  most  changes  of  heading  hardly  exceed  5°,  as  shown  on  Figure  4 which 
presents  the  return  of  the  Ship  mentioned  previously  to  Its  nominal  trajectory  after 
a 0.5  m/s  step  of  curre.nt.  (Instructions  relative  to  the  heading  were  fed  manually 
during  the  simulation). 

(b)  Mavinum  accelera  t ions , *'or  a specified  ch.:nge  of  heading,  are  proportional  to  u", 

u being  the  'ongitudinal  velocity  of  the  ship  and  n a real  number  included  between 
1 and  i. 

Considering  these  two  p.nenomena,  maximum  values  oi'  lateral  acceleration  h.  .leun 
calculated  for  various  positions  of  the  ship.  These  values  are  Indicated  ,r.  Fable  1. 

(2)  Longitudinal  Acceleration:-  When  the  ship  sails  at  a constant  engire  rate,  the  variations  of 
the  longitudinal  speed  are  very  low  for  small  angles  of  turn;  longitudinal  accelaration  is 
then  negligible  In  o.rparlson  to  lateral  accelerations.  This  does  not  apply  to  trensient  ope- 
rating conditions.  A reasonable  value  for  tne  ."■axiinum  longitudinal  acceleration  can  be  found 
by  assuming  '.net  U;e  snip,  sailing  initially  at  2.b  m/s  (It  knots)  stops  its  propulsion 
abruptly . 

The  longitudinal  acceleration  prior  tj  stopping  the  engine  is 


in  which 


f is  the  tr.ru:  t generated  l>y  the  propellers 
m tne  mass  of  the  ship 
K a coefficient  of  drag 

The  longitudinal  acceleration  af  ter  stoppin.g  the  engine  is 


1 


T 


I 
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Therefore 

F 

“l  “ ■ .11 

A reasonable  value  for  F Is  (cruising  speed) 

* 2^ 

that  is  a deceleration  of  5.10*^^  n/s^. 

It  should  be  pointed  out  that  this  decOeration  is  proportional  to  the  square  of  the  ship 
veloci  ty . 

The  results  obtained  here  have  also  teen  indicated  on  Table  1. 


Table  1.  Accelerations  of  the  ship  for  several  value  of  its  distance  from  the  ground-based  station 
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DISTANCE 
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m/s 

1 

ACCELERATIONS  | 

1 

LONGITUDINAL 
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m/s' 
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2 
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RANGE  CHANNEL 

m/s5 

AZIMUTH  CHANNEL 
rad/s^ 

33 

7.5 

5.10*5 
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5.10*5 

1.50.10*^ 

22 

7.5 

5.10*5 

5.10*5 

5.10*5 

2.30.10*5 

6.5 

3.10*5 

3.10*5 

3.10*5 

2.10*5 

12 

6 
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2.10*5 
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1.65.  10*5 
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J 
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3.  OETAlieP  FORMULATION  AWO  PESIGN 

In  order  not  to  complicate  unnecessarily  the  STS  performance  computations,  we  assume  first  that 
the  estimation  of  the  navigation  parameters  is  performed  continuously.  Once  the  estimators  have  been  chosen, 
their  Implementation  In  a discrete  form  is  studied,  as  well  as  the  resulting  disturbances. 

The  simplest  selection  of  the  variables  of  state  relative  to  the  ship  is  the  following: 

Xq  ’ 1°  Lambert  coordinate  of  the  responder 

yp  = 2°  Lambert  coordinate  of  the  responder 

Xq  = derivative  of 

c 

i'fj  - derivative  of  y^ 

and  possibly  the  following  derivative,  of  Xjj  and 

To  reduce  t{if  task  of  the  estimators,  the  nu.itier  or  vcrlables  of  state  has  teen  brought  down 
to  4;  accelerations  x and  y°  have  oeen  introduced  Into  the  model  whose  nature  is  specified  In  station 

3.2.2. 


A1  thought  the  choice  stoced  above  seems  to  be-  logical  a priori  from  <■  purely  kinematic  standpoint, 
the  use  of  the  azimuth  (A)  and  distance  (D)  measu'^ements  provided  by  the  measuring  device  may  lead  us  to 
non-linear  estimators  since 


A 


Arctg 


(1) 


t) 


(?) 


Fortunately,  A and  U vary  slowly  in  the  particular  application  with  which  we  are  concerned,  and, 
consequently,  the  variables  of  slate  of  the  system  can  be  replaced  oy 

o e 

A.  A,  0»  D, 

the  azimuth  and  distanci  accelerations  being  regarded  as  disturbances. 


i 


\ 

] 

i 


I 


I 


(r6 


The  task  which  now  retnalns  for  us  consists  In  solving  the  following  problem: 

* « * ft  O « 

Oeterffllne  the  filter  which  provides  the  best  estimates  A,  A,  0,  0 of  A,  A,  U and  0,  based  on  the 

measurenents  A^^  of  A and  of  0 (or  6^  of  B). 

This  problem  will  be  solved  by  taking  Into  account  the  following  facts: 

(1)  The  errors  affecting  and  are  completely  uncorrelated. 

(2)  The  accuracy  of  the  measurements  A and  D obtained  at  the  output  nf  the  measuring  device 
Is  markedly  higher  than  that  requested  1n"’the  specifications. 

Thus,  the  Initial  filter  is  divided  Into: 

(1)  1 filter  providing  the  best  est'mate  % of  A 

(2;  1 filter  providing  an  estimate  6 of  0 

(3)  No  filters  for  the  estimation  of  A and  0 which  are  estimated  aporcximately  by  A = 

and  0 = D_. 

fn 

Besides,  the  flltvr  (2)  will  not  have  to  be  optimal  to  meet  t.he  specifications,  as  will  be  demons- 
trated later. 


3.2.1  f 

Range  and  aainuth  tracking  loops  pro.'ide  D and  A with  muc.h  higser  accuracy  than  required:  As  far 

as  0 is  concerned,  me  error  at  1 o is  0.55  m at  the  worst  (when  the  sh.p  is.  3’  km  away),  whereas  the  error 

pertnitf  d by  the  specifications  is  up  to  20  m. 

As  regards  A,  the  error  at  i <i  is  8.6  m at  a distance  of  33  km  ,ind  2.2  rr  at  a distance  of  12  km, 

whereas  30  r and  10  m errors,  respectively  , were  allowed  by  the  spocificctio.is. 

Consequerf ly,  in  the  3TS,  D and  A are  only  estimated  by  their  reipertive  measurements.  Tnis  choice 
is  also  Justified  by  reliability  considerations,  as  will  be  shown  further 

o a 

3.2.2  Esti^Atlgn  gf_0_and.A 


0 and  A can  be  estimated  on  two  separate  channels,  as  stated  abov.;i  as  a matter  of  fact,  the  ship 
which  is  being  tracked  can  be  described  by  the  equations: 


dA 

It  ' 

9 

A 

dD 

Tt 

9 

= D 

■» 

dA 

d5 

It  • 

dt 

= ^1 

D 

0 

■'0 

= 0 

ilemented  by  measurement  equations 

0 S w UfTl  1 09 

the 

fol lowing 

>A(t) 

D 

meds . 

=• 

D - bp(t) 

in  which  and  bp  are  independent  Gaussian  white  noises.  Thus,  the  range  and  a.-imutb  channe's  are  inde- 
pendent of  e'ch  ocher. 

o 

For  the  estirration  of  A,  the  value  A^^,^;.  Is  available  at  the  computer  input.  An  "op'.i.ium"  filter 
has  been  calculated  so  as  to  extract  the  best  estimation  of  a.  We  will  take  up  this  point  again  later. 

o 

.Vd ; “.s  C t D 

*3 

The  same  filter  has  been  contemplated  for  the  extraction  of  the  Pest  estimstion  of  D based  on  the 
measurements  ; tne  estimation  error  of  this  filter  is  6.3  c-i/s  at  a distance  33  km.  As  tMs  error 

is  much  lower  than  thut  permitted  by  tne  specifications,  a sub-optimal  estimator  was  fii.ally  chosen. 

This  estimator  opera'es  directly  from  the  output  D.,  of  the  range  tracking  loc.i  and  can  be  repre- 
sented by  the  transfer  function: 

0,(T)  Ott) 


1 


I 
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An  optimisation  of  t was  carried  out  and  provides 


T - 


where  Oy  is  the  standard  deviation  of  noise  affecting  D and  a is  the  stanoard  deviation  of  accelerat lOti 


The  resulting  estimation  error  of  D Is 


= /T~o„ 


A constant  gain  structure  was  chosen  for  the  estimator  of  D,  with  -r  iptimued  at  a distance  of 


The  estimation  of  A Is  the  critical  point  of  the  STS.  The  overall  accuracy  of  the  system  depends 
strongly  np  this  estimation;  this  Is  the  reason  why  it  should  be  performed  as  accurately  >s  possible. 

Ue  will  consider  successively  the  implementation  of  a standard  Kalman  filter,  of  a Kalman-Schini dt 
filter,  and,  finally,  of  an  averageing  filter. 


3.3.1  l^alman_Fi  Iter 

nj  Calcuiacion  of  the  filter  atr:  ite  gaina 

The  first  solution  which  occurs  to  us  as  regards  the  processing  of  the  data  provided  by  the 
aaimiit.h  tracKing  loop  is  to  feed  tf.em  Into  a Kalman  filter; 


We  can  try  to  put  down 


dt  = " 


in  the  form  x 

w1  th  x^  - I A,A| 

and  the  measurements  A^(t)  In  the  form:  y - Hx  ♦ v(t) 


H being  (1 ,0) 


v(t)  being  the  azimuth  measure  noise; 


v(t)  is  the  output  of  the  azimuth  loop  excited  by  the  only  white  noise  b^(^l  whose  level  ^s  W/^(t). 

If  we  assume  that  the  bandpass  of  the  Kalman  filter  will  be  miucli  narrower  than  that  of  the 
azimuth  tracking  loop,  it  Is  logical  to  regard  v(t)  as  identical  with  b^(t);  conseque.ntly , we  have 

E(v(t)  v(t)^)  = R(t)  6(t  - t)  n W^(t)  «(t  - t)  (5) 

Consequently,  equations  (3)  and  (4)  assume  a canonical  shape  and  x(t)  Is  estimated  by  the 
following  Kalman  filter: 

o 

i(t)  = C(t.)  • i(l)  r K(t)|y(t)  - H(t)  i(t)l  (6) 

The  e:Tf1mat1on  error  of  the  covariance  matrix  P(t)  1s  a solution  of  the  equation 

^,t)  = F't)  P(t)  e P(t)  • K(‘)^  - K(t)  R(t)  K-t)"^  (7) 

where  the  gain  matrix  K(t)  Is  defined  by 

K(t)  = P{t)  H(t)^  R(t)'^  (8) 

The  solution  of  equation  (7)  Is  achieved  by  solving  the  following  llnean  equation 

^|P(t)'^i  . |P(t)‘^J  • F(t)  - F(t)^  ■ |P{t)'‘)  + H'(t)  • P(t)“‘  • H(t)  (3) 

We  find  that 


— + ot  + 

2P 


t 2 

- at*"  - 2 8t  + Y 


and  therefore 


I 6 R 


"r  ! 


Consequently,  the  gain  matrix  K(t)  tends  also  towards  0 and  assumes  the  following  fo-m 

f 4 1 


I 6 

i/J 


{2]  lyiflue^.ce  of  'lerat.icyia  ok  'he  filter 


During  the  operation  of  the  filtc  , the  ships  considered  have  a quasi -cons tant  non-zero 
acceleration  whose  variance  is  c as  we  will  ;ee,  this  only  acceleration  is  sufficient  to  cause  the 
Kalman  filter  to  diverge.  ^ 

The  estimation  error  x is  now  given  by 

X = (F  - KH)i.  + Kv  ♦ Y H3) 


as  Y ii  deterministic,  the  variance  of  x has  not  changed  but  its  average  b admits  the 
following  equation 

b(t)  = (Fit)  - K(t)  d(t),  t(t;  4 Y(t)  (1 

Since  x(0)  = £(x(D)),  the  initial  condition  concerning  b(t)  is 

b(D)  = 0 (1 


The  solution  b(t)  of  (IS)  and  (Ih)  is 

= (bj  , bjl  = l-'A  T7  ’ 

If  we  now  take  into  account  the  fact  tnat  - £(y^^),  we  find 


;(b(t)  b(t)^)  ^ 


Consequently,  the  average  quadratic  deviation  affecting  A verifies 

tf  ■ (t)  = 4 o/  (IB) 

ft  t A 

The  error  c^(t)  decreases  initially  like  t'' \ as  a function  of  t,  it  then  reaches  its 
mniTum  for  a time  t=  then  it  increases  again  like  t (see  Fig,  5).  The  minimum  value  is: 

« * / 5 3/ S 

‘A  . = *•'*  " % ' 

min 

Therefore,  the  Kalman  filter,  which  is  optimal  in  theory,  is  not  so  ir  practice.  As  will  be 
demonstrated  later,  a Kalmar, -Schmidt  filter  can  be  calculated,  is  optimal  in  a certain  way,  a.id  provides 
an  average  er,-or  c?(t)  converging  towards  a lower  value  than  that  of  the  Kalman  filter  considered  above. 


3.3.2  KalmangSchmi dt  fitter 

'!::ther  Iti.'tl  fs  r-ni  tti  ;r,  the  prjiler-. 

Let  us,,now  introduce  into  the  state  vector  the  acceleration  which,  previously,  was  not 
modelled.  It  verifies  = 0.  Consequently,  tne  equation  of  state  becomes 

■'J  ' f'o  1 '■  0 ] '/! 

I 1:  0 0 ; 1 ! ''1; 

h ^ ° 

wnere  x^  - y^  and  - |A  A| 


The  equation  of  measurenent  will  be  written  in  the  fonn 


y(t:  = H(t)  x{t)  + v{t)  » Hj(t)  xj(t)  + v(t)  (21) 

where  H = ( 1 0 0)  and  = [ 1 0) 

(^)  ^al!nan~£ahmidt  f'-l'-er\Kg 

Like  the  standard  Ka'nan  filter,  the  Kalman“Schoiidt  filter  is  a Luenberner  e^tiinator  which 
ailmits  the  equation 


X = '■x  + Kly-Hil 

One  tries  to  find  the  optimum  K anwng  all  the  K matrices  of  the 

Pll  ' ^\2 

If  we  put  down  F = , equation  (22)  gives 

■ 22 


! K. 

— 'orm. 

loJ 


'1  ^ ''ll  'l  ^ ''12  *2  * ■ *1' 


■''2  " ^22  ’‘2 


Based  on  tlie  knowledge  that  x,(0)  = £(x^(0))  optimizes  the  filter  at  the  moment  0,  it 
results  from  equation  (22  b)  that  x,(t)  is  the  avenage'-of  x,(t).  If,  besides  E{x,  0))  = 0,  i /O'  - 0 
and  therefore  x^lt)  = 0.  “■  2 2'  ‘ 

The  equation  (22  0)  can  be  eliminated  from  the  filter  which  is  expressed  as  fellows; 

0 

*1  ' hji  iij  ♦ Kjly  - Hj  xj)  ^23) 

Therefore,  the  Kalman-Schmidt  filter  nas  beconve  a filter  of  order  n^. 

(Z)  J'cj ^:2 J o/  the  cptirxil  \xirCx  K,it' 

Let  us  put  down  P(t)  - t(x(t)''^(t)  and  let  us  calculate  kj(t). 

As  in  the  case  of  tne  Kalman  filter,  the  eouation  of  the  evolution  of  P(t)  is 

O 

P(t)  = lF(t)  • K(t)H(t)|P(t)  t P(t)|F(t)  - K(t)H(t)j^  -r  K(  t)  R ( t ) k\' t ) (PA) 

which  can  also  be  written,  by  adding,  then  substracting  P(t)H^(t)  R(t;'*  H(t)  P(t)  in  the  right-side  term: 

P(t)  » F(t)  P(t)  - P{t)  F(t)''  - P(t)  H(t)^  fi(t)*'  H(t)  P(t) 

+ |K(t)  - P(t)  M/t)''  P(t)*^l  R(t)  |_K(t)  - P(t)  H(t)^  R(tl'V!  (24') 

" ’ M(1) 

O 

The  minimization  of  t'-(P(t))  leads  to  that  of  tr(P(t))  and  therefore  to  that  of  tr(M(t)i. 

As  tr(M(t))  > 0,  tr(P(t))  is  at  its  lowest  value  if  tr(M(t))  - C,  which  is  obtained  by  means  of  (B). 

Kalman  filter  ; K(t)  = P(t)  H(t)^  R(t}"' 

If,  now,  we  impose  K(t)  = , the  metrix  M(t)  can  be  written  as  follows 


"'n'n 

I Mjjd)!'  M^^(t)  J 

where  Mjj(t)  = IK.U)  - (P(t)h(t)^  R(t)'’)l  R(t)  Uj(t)  - iP(t)  H(t)^  R{t)'‘j) 

■ ■'’'‘I  K(t)  l<P(t)  H(t)''  R(t)'*'Ji 

= I (P(t)  H(t)^  R(t)"' i|  R(t)  I ;P(t)  H(t)^  R(t)''-J| 

/ ? 

If  we  u'.e  tr  M,;t)  = tr  M (t)  ♦ tr  and  the  fact  that  M,,(t)  is  independent  of  K,;t), 

we  find  the  following  result  **  * 


Minimum  tr(M(t))  -K  (t'  = (P(t)  K(t)^ 


which  we  sum  up  as  follows 


Kalman-Schmidt  Filter 


K,(f)  = iPit)  H(t}^ 

' I 

^2^1)  ^ 0 
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(ij  r.vc'utijn  c;  the  ratris:  P(t) 

Through  the  transformation  of  (24')  by  means  of  (25),  the  matrix  P(t)  1'  the  solution  of 
the  iJi fferentlal  equation 


P(t)  = F(t)  P(t)  + P(t)  F(t)^  - P(t)  H(t)^  R't)*^  H(t)  P(t)  + i 
from  the  Initial  condition 


j^o  i[Pit)  H(t;T  P(t)-1  H(t)  P(ti)jj 


(26) 


P(0) 


Pjl(0)j 0_ 

0 ! E(x2(0)  x^(0)^) 


The  introduction  of  the  fourth  term  into  the  right-hand  side  of  equation  (26)  corresponds 
sin,  y o cancelling  the  fourth  block  of  the  ratrix 

P(t)  H(t)^  Rtt)'^  H(t)  P(t) 

Equation  can  be  solved  according  to  the  same  process  as  the  evolution  equation  (7)  of  P(t) 
fur  the  Kalman  filter. 

!i)  Appl'catior.  C'f  the  ha'.r^K-Sehnidt  filter  to  the  filtering  of  ozimuth  dato 


In  this  phase  of  the  study,  we  will  not  be  concerned  with  transient  operating  conditions. 
It  is  demonstrated  experimentally  that  equation  '26)  admits  such  a stable  solution  that  p,,,  p,,  and  p 
verify:  “-s 

_ 5 


33 


° Pp2 


3 p 


11 


6 


^ y = P33 


ni 


16  R' 


and,  consequently,  c°.,  the  speed  estimation  error  is 


« 1,41  o 

A Y 


(27) 


The  steady  state  error  is  S%  smaller  than  that  of  the  Kalman  filter  at  its  most  accurate. 
Fom  of  the  filter 

The  calculation  of  K^(t)  by  means  of  formula  (25)  leads  to  the  following  result 


1 im  Kj( t)  » 


2 '.'5 


iV 


(28) 


with  (-^) 


o Under  steady  corditiuns,  the  tranfer  function  from  the  measurement  A (t)  Co  the  estimate 

A of  the  izimuth  speed  is 


Mr!  = 


P 


'‘■nip)  /2  OqP  V p^ 


l29) 


The  Kalman-Schmidt  filter  obtained  has  its  iwo  eigenvalues  with  a critical  damping  in  the 
complex  plane.  Its  blocK-diagrum  is  represented  or.  Fig.  6. 

i'^l  Maxxrrx'n  error  of  toe  Kalman-Sohrridt  filter 

The  maximum  speed  estimation  error  of  the  filter  is  to  be  found  at  a distance  of  33  km; 
b.*,ed  0:1  formula  (27),  ’t  amounts  to 


= 11,3  cin.'s 

3.3.3.  ^^?Eageing_f 1 1 ter 

At  the  request  of  the  STS  project  leader,  a more  conventional  estimator  of  the  azimuth  speed  A 
has  been  calculated  and  made  it  possible  to  quaritify  the  accuracy  improvement  offered  by  the  Kalman-Schmidt 
Tilter  over  -lore  conventional  filtering  methods. 


i I}fi8  'viptten  of  filler 

The  averageing  filter  operates  as  follows: 

The  measurements  4 (t)  supplied  by  the  ineasuring  equipniont  is  averaged  during  consecutive 
time  periods  of  fixed  duration  t/2,  T being  optimized  later. 


Tb<*  A Is  calculated  as  (2  T)(A<  - Ai-i)  wtiere  Is  the  result  of  f e 1 average  and  A^.j 

that  of  the  i-l^.'Tlaie  V has  been  calculated  in  suer,  a wey  as  to  optimize  the  accuracy  of  the 
estimation  at  a distance  of  33  km.  '^i.e  steady  state  error  'las  been  calculated  at  follows: 

(3J  Steady  state  error 

According  to  the  superposition  principle,  the  Steady  state  error  is 

= 'k)\  * 

where  (t^)j  is  the  error  induced  by  radio  freque-icy  noise 

and  (£^>2  the  error  resulting  from  the  non-iero  acceleration  of  the  ship,  whose  standard  deviation  is 

Cahrulatior,  o'  fcfj 

T ^ 

As  time  w is  long  as  compared  to  the  reverse  of  the  bandpass  of  the  atimuth  tracking  loop,  in 
calculations,  the  Coloured  noise  at  the  output  of  this  loop  can  be  replaced  by  the  white  noise  o^(t)  at 
the  input  of  the  loop. 

The  er"-o.'  affecting  A.  is  therefore  the  weighted  integral  of  tho  white  noise  b^{t);  consequently: 

---2- 
Aj  1/2 

Likewise,  the  error  affecting  A._j  is  given  by 


T/2 

and,  due  to  the  fact  that  the  l>y^(t)  are  independent  of  each  other,  for 

t 6 1 t,.|  , t.)  ar.d  t e ( t..^  . t,.jl  , 


1 . _2R.  . 16  R 

(T/2)2  T/2  t3 


Ltt  us  assume  that  the  white  noise  b^(t)  i'  zero  and  that  there  is  a constant  acceleration  •,  (t) 


A(tui) 


. • |h-.-  7 . 


b,(t)  = 0 . A Jt)  = A(t); 


A(t  t II  V A(t)  r 2 A(t)  t 1.  y 
2 2 8 


Therefore 


i>r  7?  I '■*  ^ ’ A(t„.  * J)  ^ i V = - : 


Consequently 


i'lK  - 

" 2 2 4 V 


It  results  therefrom  that  the  ovciall  error  is  given  by  the  formula 


o / 16  R T"^  2 

c,  - . — + --  o 


This  error  Is  at  Us  smallest  for  T = (20, 

n A 


' 1,61  R 


l/S  -,/s 


(32) 


hi: 


The  minimum  error  at  a distance  cf  33  km  amounts  to  12.9  cni/s  and  corresponds  to  an  integration  time  of 
20  s (T/2  = 20  s). 

O 

Now,  the  specifications  require  that  the  display  of  A should  be  up-dated  every  five  second;  therefore,  we 
are  compelled  to  carry  out  several  calculations  of  averages  in  parallel  for  with  an  elenientary  5 s shift, 
or  to  select  a 5 s integration  time;  the  error  obtained  in  the  latter  case  is. 

a 65  cm/s 

O 

3.3.4  §?lect1on_of  the_estimatign_f i ]ter_of_A 

The  accuracy  performance  of  the  three  filters  under  consideration  is,  respectively: 

Kalman  Filter  (12.2  cm.  , at  33  km) 

Kalman-Schmidt  Filter (11.3  cra/s  at  33  km) 

Averageing  Filter...'. (12.9  c/Vs  or  65  cm/s  at  23  km) 

The  iCalman-ichmidt  filter  has  been  selected  since  it  is  the  .most  accurate.  A.;  already  noted,  the 

drawbacks  of  the  other  filte.'S  are  the  following: 

Though  ade.udte  i>i  ’.'■■e.r'j  , the  Kalman  filter  is  difficult  to  use  due  to  its  divergence. 

While  the  averageing  filter  appears  to  be  simple  a priori,  it  is  somjwhat  difficult  to  in.plemort 
if  a low  degree  of  error  is  to  be  achieved;  besides,  even  onre  it  has  been  optimizeo,  it  does  not  ineet  the 
specifications  required  (12.9  cm/s  at  a distance  of  33  km  instead  of  12.5  cm/s).  The  ettination  errors  of 
the  various  filters  are  represented  on  Fig.  7.  versus  the  distance  fror.i  the  ship  tc  the  station. 

3.4  Estimation  of  cnt _navigat ign_parameters 


3.4.1.  Mjthe.mat  i cal  ^express  ion  _of_  the.  navi  gat  lon^garameters 


The  navigation  para.meters  e,  L,  e and  L are  expressed  as  functions  oi  the  real  values  A (azimuth) 
ard  C (distance)  oy  teans  of  the  following  formulae 


(»o  ■ -'i  • * '^0  • *'i  ■ ^-l> 


s • a W 4 (b  • b \ 
i i - 1 i i - 1 ' 


(33) 


L(x,)  = 1 ,x^  • a, 

)■•  w iy, 

0 - b 

_ dt  ‘ 1 i-i 

' ' dt 

1(4,  - a,.j)^  V (b.  - b..j'^ 


(34) 


(35) 


dx„ 


^ ^ ■ *’i) 

'9  90 

I (*0  - 4^)  t (/q  - 


(36) 


where  is  a correcting  term-,  resulting  from  the  position  deviation  between  tiie  responder  and  the  pilot. 

' 1 
. j . 

^ are  the  Lambert  coo’‘dinates  (Cartesian  coordinates)  of  the  refei'ence  point  x^ 

“i 


I i 

and  I I 

' 4'o 


■"i«  3 

' I 

lit  , 


I I 


Hy  are  respectively  the  coordinates  of  the  Ship  responder  and  their  dc 
expressions  as  functions  of  A,  X,  D and  6 are: 

dt  I 


derivatives,  whose 


x^  = x^  ♦ 1)  sin  A 
Vq  = y^  ♦ 0 cos  A 


(37) 

(38) 


dx 


^ = y cos  A ^ V Sin  A ^ 


(39) 


■^0  , (lA  , dD 

“ar  ' ■ ^ sin  A V cos  A ^ 


i‘io; 


where 


are  the  Lambert  coordinates  of  the  ground-based  station. 
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3.4.2.  of^navijation  garanteters 

O 6 

Eetv<x2tior  of  K,  L(x^),  e,  L(x^) 

O O 0 0 

The  expressions  of  e,  i.,  e and  L as  functions  of  the  values  of  A,  0,  A,  D are 

- linear  as  functions  of  & and  6 

- non  linear  as  functions  of  A and  D. 

Based^on  the  fact  that  A^*nd  0 are^kr^wn  with  fairly  good  accuracy,  we  have  chosen  as  the  esti- 
mates of  e,  L,  e and  I the  “alues  e,  t(x^),  e,  L(x^)  provided  by  the  formulae 


e = e(A.O)  (41) 

L(x^)  = L(x^,  A.  0)  (42) 

e = e(A,  0.  X,  6)  (43) 

L(*,)  ^ L(x^.  A.  D.  X.  8)  (44) 


where  e(.),  l(.),  e{.),  L(.)  are  the  functions  ap^>earin9  In  tne  right-hand  sides  of  (33).  (34),  (35  ) 
and  (36).  Due  to  the  good  accu'acy  A and  0,  these  estimate  are  close  to  tne  optimum. 

D«i6minatio>-,  of  th»  reference  fx^  j 

The  reference  segment  is  dc'termined  iteratively  since  the  tanxer  sails  toviards  the  ’'xrpour.  The 
test  pe™ilt1ng  tt  e Incrementation  of  i rgrreiponds  to  the  tanker  parsing  across  the  boundary  which  sep-rates 
the  1+lth  area  of  the  channel  from  the  i^harea.  This  test  is  carried  out  simultaneously  with  each  calcu- 
lation of  e and  L(x^),  that  Is  to  say  every  second. 

(1)  Aoc'uxv.0-^  aokie-jei  for  e and  L(x^) 

The  accuracy  achieved  for  e proves  to  be  almost  the  same  as  the  lowest  accuracy  for  A 
(expressed  In  tr.)  and  P.  By  means  of  a simple  calculation,  we  find  that  the  error  affecting  L is,  at  the 
outside,  egual  to  twice  the  greatest  error  affecting  A and  0.  Thuc,  the  errors  ^ and  c.  in  the  estimation 
of  e and  L are:  ® ^ 

At  a distance  of  33  km 

At  a distance  of  12  '.m 

>)  0 

(2)  Aacuraoy  oahitved  for  e and  L(x^) 

O O 

The  accuracy  achieved  for  e and  L(x.) 
almost  independent  of  the  errors  affecting  A and  D; 

A detailed  calculation  has  revealed  that  the  greatest  possible  error  obtained  is  1.2  cm/s. 

O C 

a , He  have  also  been  able  to„dcmonstratc  that  e und  L(x.)  are  almost  the  optimal  esfimates  of 

e and  L(xj)  and  triit  the  error  affecting  e and  L(x()  is,  at  the  utmost,  equal  to  that  affecting  A;  Tiio 
degrees  o''  accuracy  achieved  for  e and  [(x.)  if  we  estimate  « by  means  of  a constant  coefficient  filter 
optimiied  for  33  km  (by  Ka Imar-Schtr , dt  filtering)  are  shown  on  the  table  below: 


c » d.b  m 


1 .<  17.2  m 
E,  X 4.4m 


estimated  by  means  of  equations  (43)  and  (44)  is 


Distance 

(km) 

(cm/s) 

(cm/s) 

— 1 

vdCx 

( cm/  i 



vdL, 

(cm/s) 

33 

8.  5 

12.9 

P.6 

22 

8.3 

11.3 

11.1 

11.  ’ 

5.3 

6.  7 

t.5 

5.5 

12 

4.  7 

4.5 

4.7 

2.2 

1. 1 

1 

2.2 

L_ 

Errors  affecting  and  as  ftjnctions  of  the  distance 
between  the  tanker  and  tie  g-oimd-baseJ  station  (zero  lag  errors) 
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3.5  Octimizatlon  of  the  STS  digital 

Ksa«saaasjass89s89laauasessssas3isallaasai 

o 

(1)  Sarrpled  K^l'^n-Sahm'dt  Filter 

The  discrete  formjlation  of  the  sampled  Kalman-Schmidt  filter  is  given  belnw. 
Suppose  a sampled  process  in  the  form 

x(k  + :)  = ♦(k+1,  k)  • x(k) 


whaie 


(45) 


x{k) 


[-xj(k) 

1 Xj(k)  I 

L_  ^ _J 


and  ♦(ktl,  k; 


*11  *12 
0 4 


22  ! 


Suppose  the  sampled  measurement 


y(k)  . H(k)  x(k)  ♦ v(k)  . Hj(k)  Xj(k)  ♦ v;k) 
where  v(k)  is  a sampled  white  noise  with  the  following  coveriance 

E(v(k)  v(l)^  - R(k)  6 


(45) 


kl 

The  Xalman-Schmidt  filler  which  optimizes  toe  ei.tlma*'lon  error  affecting  Xj{^;  Is  given  by: 


^^(k/  = :j{k)‘  i Kj(k)  !y(k)  - Hj(k):j(k;‘l 
XjO'  1)'  ' >tj(k)* 


P(k)*  V P(k)‘  ■ P(k)'  H(k)hlk(k)  » H(k)  P(k)'  H(k)^|):‘ 

r — — • ^ - -*t 


•^1  '^2  1 

where  {.),  is  the  operation  which,  from  0 = I leads  to  (OK  ' 


1.  '3  «4j 


Q,  Q2  j 

°j 


P(k+1)'  . »'k  1.  k)  P(k)  ♦(k*l,  k) 


kj(k)  = (P(k)‘  H(k)^(R(k)  ♦ H(k)  Pik)'  H(k)^|'^| 


where  {•);  is  the  operation  which,  from  w 


leads  to  (M), 


(47  a) 
(47  b) 

(48  a) 

(46  b) 
(49) 


Where 


{.'.J  1 Js,  i idpti  ij  th/*  f I A 

e 

Let  cs  call  T fc  sampling  interval  of  the  falman- ji.h.T,ldt  filter  of  channel  A. 
The  evolution  of  the  vector  of  state  x(k)  = | ik  given  by  the  formula 

i^A<‘k,)J 

x(k)  = »/k,  k-1)  x(k  1) 


FT 


l>  ’ 


♦(k,r-l)=e  »jO  1 f 

jo  0 1 


The  sampled  n.easjremonls  selected  y(f  ) JSSuhK!  the  fo’ lowing  form 

1 f 

y(l')  " J j 

^-1 

They  are  tne  averages  of  the  atinuU.  n-casurcrw-nti,  in  the  1nt''rvais  i j,  t^l 
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If  w*  use  A^(t)  » H • x(t)  + v(t),  where  H ■ 11,0,0)  ana  E(v{t)  v(t  + t)^)  » R S(t) 

we  obtain 

y(k)  . H(k)  x(k)  + v{k) 

H(k)  . H . (i  T''  *(t,  t^)dt)  = I 1,  X* 

^ Vl 

E(v{k)  v(l)^)  = R(k)  6^,  where  R(k)  « ” 

The  steady  state  accuracy  of  the  Kalman-Schtnidt  filter  corresponding  to  the  above  sampled 
equations  was  calculwted  for  various  sampling  Intervals  at  the  most  critical  distance:  3J  km.  The  average 
error/sampling  Interval  curve  shown  on  Fig.  8 offers  a remarkable  characteristic:  the  aacuraay  ie  at  itu 
beat  for  a ncn-aaro  value  (of  the  order  of  10  a)  of  the  eampling  interval  and  Is  lower  than  that  of  the 
continuous  filter  only  when  the  sampling  Intervals  exceed  22  s. 

For  a 5 s sampling  Interval,  the  accuracy  achieved  Is  11.1  cm/s. 

A F s sampling  Interval  Is  selected  In  vle«  of  the  following  requirements 

O 6 

(a)  Update  the  estimation  of  e ana  L for  each  data  display 
(bl  Mlnlmlee  the  computer  work  load  for  tlie  estimation  of  A. 

O 

3.5.2 

The  sampling  Interval  of  estimator  5 Is  not  critical  and,  for  tlie  sake  of  simplicity,  was  chosen 

as  1 s. 

3.5.3.  !Elf(!9£''.9f.9i9lJ5.5?]?SE?9.f95.?i5t!.P9C?1l9Esr 

Th;.  computer  used  Is  an  8-b1t  cofl.puter  based  on  an  INTEL  80P8  fixed  point  microprocessor. 
Consequently,  the  parameters  should  be  derlned  either  In  8 bits,  or  In  16  bits,  or  more. 

o o o o 

It  has  beer  demionstrated  that,  for  each  of  the  varlaoles  D,  D,  A,  A,  e,  L,  e and  L,  the  dynamics 
exceed  8 bits.  Consequently,  these  variables  must  be  coded  In  16  bits,  that  Is  to  say  two  words. 

The  following  table  shows  the  values  of  the  highest  and  lowest  order  bits  for  each  value,  together 
with  the  appropriate  signs. 


Value 

Sign 

— 

Max.  Weight 

Mir.  Weight 

D 

32,768  ro 

1 m 

ft 

0 

+ 

64  m/s 

3.9  tim/s 

A 

♦ 

« rad/S 

0.96  • 10'^  tad 

A 

♦ 

12.27  rad/s 

7.4  • 1C  ^ rad/s 

1 ^ 

16.334  n 

1 m 

1 

1 L 

32,768  m 

1 m 

1 

1 « 

t 

64  m/s 

3.  9 mm/s 

1 O 

1 1 

1 

+ 

64  m 

3.  9 nm/5 

In  all  the  cases  considered,  the  unit  of  lenght  Is  1 m and  the  unit  o'  time  2®  s,  that  is^to 
say  J.9  ms.  The  only  values  which  arc  not  slandardueJ  are  A and  A,  which  makes  the  computation  of  x„ 
and  yg  more  complex.  ^ 


ihe  value's  provided  by  the  measuring  device  are  given  In  the  following  form 


1 

Value  i Sign 

— 

Max.  Weight 

Min.  Weight 

! 



1 

*■  I 65  536  ra 
analog  coded  16  bits 

♦ j » .-ad 

I 

analog  coded  a hits 


3.5.4 

A(k)  1s  determined  b>  the  algo.'lthm 

A(k+1)  = Ojj  A(k)  » 4j^  A(k)  ♦ Kj(A  - »jj  A(k)  - 0 Mi')) 

A(kvl)  = M*')  ^ ’^2)*  - »11  ' *12 

where  une  parameters  expressed  In  octal  numbers  are: 

= 0 0 0 1 (1) 

♦j2  = 0 5 0 9 (T) 

»'j2=  0210  (T/?) 

» 0 0 0 I (I) 


Approximaf 'i.g  6.  and  n,  does  not  apprec.ioly  modify  the  flUcrIng  error;  besides,  no  appioxl- 
matlon  is  made  for  «j  ‘ 

F-rrore  rea-^'.:ir,^  ;'rc~,  the 

Such  errors  are  null . 

reaultinj  rr^r  thj  trunaalijr,  of  A frc^.  ‘>\e 
The  conputer  calcu’ates  (50)  and  (51)  according  to  the  following  process: 


•at; 


C A - A - A(k)  - ♦ A(k) 

. - j „ . - 

A(ktl)  = A(k)  * 0,^  A(k)  r Aj  ;.A 


Tnat  is  to  say: 


A(k»i;  = A(k;  t . tA 


A A t I - A(k)  - } A(k)  - 


\ 


A{k»l)  = A(k)  * A(k)  t Kj  aA  t 
A(k*l)  = A(k)  t oA  ♦ 

c,,  t,,  c,  are  errors  equally  distributed  over  0 and  b where  b Is  thp  lowest  order  bit  of  A and 

A(A  ♦cA)f  ^ 

' m.  m ' 


equlvalen 


The  average  of  r . , t..  t-  does  not  perturb  A In  3 steady  state.  The  standard  deviation  of  an 
It  noise  c ' , on  A Is  : ■’ 


b 1 A h 

rP  ♦ ^ ^ 


Such  d noUe  Is  equivalent  to  a white  noise  on  A^,  wnose  energy  level  would  bo 

p 

W , = 1 . — = 1 .15  • 10‘®  rad^/s. 

‘ 1 

This  level  is  higher  than  the  energy  level  or  the  input  white  noise  for  distances  below  1?  km 
between  the  ground-based  station  and  the  rcsponderl 
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3.5.5  f ■ StsilV*.  5r  .DSD:5^5Bl?UY*.!f^l0?D:5?!35'ldt. [liter? 

The  Imp'erientatlon  of  a Kalman-Sch^idt  filter  with  pre-computed  variable  coefficients  has  been 
contemplated  during  ST5  study. 

Finally,  tils  Idea  was  given  up  fnr  the  following  reasons: 

The  coTiputlng  ivorkload  of  an  adaptative  filter  1s  higher  than  that  of  a constant  coefficient 
f i 1 ter. 

On  the  range  channel,  the  acquisition  Is  achieved  by  the  measuring  system  within  2 mn 
whereas  the  acquisition  time  Is  reduced  tn  2 s on  the  azimuth  channel.  Therefore,  a snort 
transient  phase  Is  not  a necessary  requirement  for  the  azimuth  Kalman-Schmidt  filter; 
consecuently,  the  gain  parameters  can  be  frozen  at  their  steady  state  values. 

Howevi'r,  it  has  beer,  contemplated  to  set  up  later,  on  the  ST‘',  a gain  adaptation  program  for 
the  previous  filter;  the  gains  should  be  calculated  as  functions  of  the  S/N  ratio  at  the 
input  of  the  measuring  device.  This  5/N  ratio  is  given  indirectly  by  a variance  computation 
earn'd  out  on  the  azimuth  measurements  stored  in  the  menory  every  500  ms.  The  principle 
of  the  '"Iter  is  represented  by  a block-diagram  on  Fig.  9. 

The  worst-case  results  to  be  expected  from  such  a filter  are  shown  on  Fig.  10,  together  with 
those  obtained  with  a constant  coeffiuient  filter  whose  coefficients  are  optimized  tor  a 
distance  of  33  km. 

It  is  this  constant  coefficient  f'ller  which  will  be  considered  from  now  on. 

4.  geheral  organization  of  the  digital  processing 


due  to  its  low  cost  and  its  low  computing  power,  the  computer  of  the  STS  ground-based  station  Is 
quite  suited  to  the  problem  unde>'  consideration. 

The  computer  is  connected  with  the  measuring  device  by  a 32-entry  • 32-exit  coupler  whose  functions 
are  as  fol  lows  . 

Input  of  data  U , A , 0 , return  message  f'-om  the  responder, 
fn  fr.  fT 

• Output  of  the  outgoing  message  sent  to  tne  responder. 

The  computer  operates  on  three  levels  (see  Fig.  11). 

0 500  ms  elementary  period  main  program  synchronizeo  with  a 500  ms  period  Interrupt  sent  out  by 

the  measuring  device.  This  orogran  Is  responsible  for  the  fpriowlng  computations: 

I'.'l  Average  of  the  10  A data  and  coniputation  of  the  constant  coefficient  Kalman-Schmidt 
flltar  (e»ary  5 s). 

9 • 

(i)  Iterative  computation  of  0 by  the  processing  of  sampled  every  second. 

(V  Computation  of  e arc  L(x.)  every  second  by  sampling  A every  500  ms  and  0 every  second. 

q e ■ fn  fn 

(4)  Computation  of  e,  L(X|)  every  5 second. 

Computation  of  the  segment  num'.er  and  phase  number  every  second  ba^ed  on  the  result  of  (3) 

0 t 

The  iTialn  program  Is  synchronized  in  order  thot  the  computation  time  of  the  estimates  of  A and  0 
may  remain  constant.  Computations  IV,  12),  (})  , 14},  aiid  (S)  are  not  al  i effected  at  a 500  ms  rate  but 
are  repetitive  every  5 second. 

Tiie  time  schedule  of  the  main  program  Is  as  follows; 

0 Computatlof,  of  cos  A and  sin  A,  of  the  Lambert  coordinates  x„  and  y». 

Determination  of  segment  1 and  phase  j.  ^ 

Input  of  A , 
n 

0.5  Computation  of  P and  L(x^). 

Input  of  A„,.  5 

Estimatiun  of  0. 

1 Computation  of  cos  A,  sir.  A,  x-  and  y^,. 

Determination  of  1 and  j. 

Input  of  A . 

fll 

1.5  Computation  of  e and  Ljx,) 

Input  of  A„.  o 
Estimation  of  D. 

2 Computation  of  cos  A,  sin  A 
Determination  of  1 and  J 
Input  of  A 

w 

2.5  Computation  of  e and  L(Xj) 
input  0-  A^  Q 
Estimation  of  5 


3 

I 


I 
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3 CfMiputatlon  of  cos  A,  sin  A,  x«  and  y- 
Determination  of  1 and  J 

Input  of 

3.5  Computation  of  e and  L(x^) 

Input  of  A^  o 
Estimation  of  D 

4 Computation  of  cos  A,  sin  A,  x^, 

Determination  of  1 and  J ^ 

Input  of 

4.5  Computation  of  e and  L(x.) 

Input  of  A„  « 

EstiMtIon  of  A 
Estimation  of  6,  o 
Computation  of  e and  L(xj) 

Return  to  0 ’ 

The  computation  times  of  the  various  sub-programs  are: 


Computation  of  cos  A and  sin  A 

7fi  ms 

Computation  of  Xq  and  y^^ 

0.  3 ms 

Determination  of  segment  1 and  phase  j 

32  ms 

Computation  of^e  and  L(x^) 

73  mr 

Estimation  of  D 

5 ms 

Estimation  of  A 

13  ms 

Computation  of  e and  L(x^) 



40  ms  1 

The  total  space  requirement  of  the  program  Is  4 words. 

1 Program  over  an  Interrupt  of  level  1 triggered  by  the  measuring  device  every  500  ms.  This  program 
projares  and  transcodes  Into  SCO  the  digital  message  of  33  eight-bit  bytes  to  be  sent  to  the 
responder. 

ieuel  2 Program  over  the  Interruption  of  level  2. 

This  program  Is  Initiated  every  14  ms  on  the  Interruption  of  level  2 triggered  by  the  meoturing 
device;  It  sends  out  to  the  measuring  device  *n  eight-bit  byte  of  the  message  generated  previously 
and  receives  an  eight-bit  byte  In  return,  tviilch  It  compares  with  the  cight-bit  byte  sent  out  and 
It  sends  forth  an  alarm  signal  If  an  eiror  has  been  made. 

88  ms  are  required  for  the  running  of  the  1st  and  2nd  .»vel  programs,  out  of  a total  duration  of 
500  ms,  which  leaves  41'.  ms  for  the  main  program  to  be  carried  out.  Now,  the  running  of  this  main 
program  necessitates  ’.1  ms  at  the  utmost.  Therefore,  the  computer  remains  unused  over  SOX  of 
Its  timel 

The  total  space  requlrerient  for  levels  I,  2,  and  3 Is  5.3  K words. 

5.  RELlAfllLlTY  OF  THE  DIGITAL  PROCESSING 

As  Shown  on  Eig.  11,  the  digital  processing  by  the  STS  ass'.ne5  a modular  structure.  Its  charac- 
teristic features  are: 

(1)  No  estimation  of  values  A and  D (This  way,  even  in  the  case  errors  occur  on  the  estimators, 
parameters  e,  L(Xj),  1 and  j are  available  on  the  pilot's  display  box). 

(2J  Separate  estimation  of  i and  P. 

f2}  Rust1cU>  of  estimators  X and  &,  ensuring  high  stability. 

(4)  Estimation  of  navigation  parameters  separately  from  that  of  the  variables  of  state. 

The  modular  structure  of  the  programs  Improves  considerably  the  re. lability  of  their  checking 
Out  and  of  possible  on-s1te  modifications. 

CONCLUSION 


This  paper  describes  the  digital  processing  of  measurements  In  a high  accuracy  ship-tracking 
system  The  errors  affecting  the  azimuth  measurement  supplied  by  the  measuring  device  of  me  ground-based 
station  wer^  found  to  be  the  roost  critical  for  the  overall  accuracy  of  the  system.  A KMman-SchmIdt  filter 
was  selected  for  an  optimum  estimation  of  the  azimuth  speed,  following  comparisons  with  a Kalman  filter 
and  an  "averageing"  filter.  The  estimation  of  the  navigation  parameters  was  described  and  the  position 
and  speed  accuracy  achieved  by  the  system  was  calcul'ted.  Moreover,  various  effects  resulting  from  the  data 
processing  in  a computer  were  analyzed  and  optimized:  f.1.  choice  of  the  computation  rate  for  the  azlim.th 
velocity,  scaling  of  navigation  parameters,  jtc  . ; f'nclly,  the  pi'ogramming  of  the  data  processing  1n  x 
microcomputer  was  described  and  evaluated  from  tvo  standpoints:  memory  space  requirement  and  romputatlsr 
time.  The  results  obtained  confirm  the  efficiency  of  the  solutions  selected. 
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Figure  10.:  Standard-deviation  of  the  speed  error  as  a function  of  the  distance  ship-ground  based  station, 
for  the  Kal«tn-Scnm(dt  f'lter  optimized  at  33  kn  (curve  n°  1),  and  the  same  one  made  adaptive  (curve  n°  3) 


Period:  433  ms  x 32 
Program  on  level  2 interrupt 

Figure  il.:  Organization  of  STS  Data  Processing 
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SUMMARY 

This  lecture  describes  the  typical  steps  and  considerations  for  desisning  low- 
order  efficient  state  estimators  or  Kalman  filters.  The  design  steps  are  demonstrated 
01.  3 platfom  alignment  problem  where  Kalmiin  filtering  is  used  rather  than  conventional 
procedures  to  reduce  the  time  necessary  for  the  required  alignment  accuracy.  The  work 
reported  herein  is  based  on  a test  series  for  modelling  gyro-drift  and  accelerometer 
errors.  The  main  body  of  the  lecture  concentrates  on  the  selection  of  a desigr.  model 
for  the  filter  (Section  2),  tne  filter  design  itself  (Section  3),  and  a complete  covari- 
ance analysis  (Section  4).  The  main  goal  of  the  filter  design  is  to  achieve  a simple, 
i.e.,  low-order  insensitive  design. 


1.  INTRODUCTION 

The  application  of  modern  estimation  techniques  (Kalman  filter. ng)  to  the  align- 
ment and  calibration  of  inertial  platforms  (on  ground)  is  of  great  practi-al  interest 
since  it  allows  shorter  alignment  times  and/or  higher  alignment  .accuracy.  Both  aspects 
are  very  desirable  because  they  allcw  the  time  necessary  for  start  preparations  to  be 
shortened  and/oi  inflight  navigation  accuracy  to  be  improved  (I,  2j*.  1 i om  the  viewpoint 

of  implementation  it  is  desirable  to  lieep  the  estimator  as  simple  as  possibit  while  main- 
taining the  optimal  accuracy.  The  t.pical  design  stops  for  achieving  simple  ilow-ordcr) 
and  efficient  filters  are  described  for  the  problem  of  f.ast  .and  fine  platform  alignment. 
This  problem  should  bv  understood  as  a case  study  which  illow..  aspects  of  fi’ter  design 
which  are  typical  and  easily  generalised  to  be  described.  The  practis.nl  implications 
of  the  numerical  results,  however,  depend  on  the  special  mission,  an.l  generalisation  must 
be  performed  with  care. 

To  obtain  reliable  answers  to  this  problem  the  followin'’  mairi  tasks  were  sarried 

ou  t : 

(1)  A test  series  for  setting  up  stochastic  models  for  gyio-diift  and 
accelerometer  errors  (at  I AHG-Ot tobrunn) . 

(2)  A design  of  an  effective  low-order  state  estimator  with  special 
attention  to  observability  and  covariance  analysis  (at  I'l  CLR-fiber - 
pf  a f f cr.ho  fen)  . 

(3)  Coordination  of  modelling,  implrmcntat icn  of  the  filter  and  perfor- 
mance of  experiments  with  the  real  platfoin  (ai  DF  V I,  R- b r auns,.  hwc  i g 1 . 

The  lecture  concent. ates  on  task  |2);  however,  upgrading  the  results  of  task  r I 1 
and  the  comparison  with  the  experiments  of  task  (3)  an,,  their  drawbacls  on  tasks  il) 
and  (2)  are  alsti  included. 

Each  of  trie  following  sections  begins  vith  a subsection  on  the  general  idea  - appli- 
cable to  a wide  range  of  problems  - followed  by  a discussion  of  its  use  i r.  tb..-  problem 
of  alignment. 


2.  DYNA.MIL  MODLLS  AND  LRROR  MAT  I -BT  1 CS 

Effective  state  estimation  via  Kalman  filtering  is  based  en  a model  cf  the  dynamic 
system  under  consideration,  the  sensor  equations  as  well  as  statistic  modcl.s  fer  the 
noise  inputs  (process  .and  sensor  noisel 
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vectors  termed  as  process  and  neasurement  noisi,  tlicv  arc  usu.allv  .issiimed  to  be  whit'  - 
noise  terms  with  zero  me, in  and  spcct,.il  ‘i.nsity  matrices  Q and  R,  re  spc.  t i ve  1 > . 


Bracketed  numerals  refer  to  simil.irlv  numl-.e  red  re  f e rcn,.  < s in  the  list  of  Rofirenics 


TKo  matrices  F,  G,  H.  Q,  and  R are  usually  assumed  to  be  precisely  given  and  may  be  con- 
stant or  time-varying. 

In  practice,  however,  this  assumption  is  almost  never  fulfilled,  i.e.,  usually  mo-  I 

dels  wltn  sufficient  precision  are  not  available  and  modelling  is  at  least  partially  the 
Job  of  the  filter  designer,  moreover,  it  usually  is  the  toughest  part  of  the  whole  pro-  | 

blem.  Once  a model  is  established,  the  rest  of  the  work  is  almost  straightforward.  The  j 

optimal  (continuous)  estimator  or  Kalman  filter  is  then  of  the  form,  see  e.p.  [3]  | 


X - F X ♦ CyU  ♦ K(t)  (r  - H x]  (2-3) 

In  this  formulation,  the  state  estimator,  Eq.  (2-2)  is  of  the  same  order  as  the  dy- 
namic system,  Eq.  (2-1),  whose  state  is  to  be  estimated.  There  may  be  many  good  reasons 
for  lowering  the  order  of  the  estimator,  c.g.,  the  use  of  so-called  "kinematic  estimators", 
neglection  of  unimportant  states  as  well  as  restricted  observability  properties.  This  is 
discussbd  in  the  following  sections. 


“• ’ Kinematic  Modelling 

For  modelling  our  dynamic  system  wc  t?ke  a viewpoint  which  is  sometimes  described 
as  "kinematic  modelling";  it  leads  to  a suboptiAial  filter  of  reduced-order  which  is  in- 
sensitive to  several  parameters  [4,  S]. 

The  pro-edure  can  briefly  be  described  as  follows:  assume  that  the  total  state- 
vector  X can  be  split  into  two  portions,  Xj  and  of  order  nj , n,  (nj  ♦ nj  • n) , where 


X,  - F,  , X,  ♦ _F,  , X,  (2-4) 

X,  - f , (x,  , X,,  u,  -w)  (2-5) 


In  the  context  of  mechanical  systems,  Eq.  (2-4)  is  the  set  of  tinta.\izzd  fetncmafic 
z^uatiom  which  describes  the  dependencies  of  angles  and  angular  velocity  components 
for  rotational  motions.  The  second  set  of  equations,  Eq.  (2-5),  is  then’ the  dtjnamic 
equations  of  motion,  which  need  not  even  be  in  linearized  form,  since  they  are  elimira- 
ted  in  the  following.  These  latter  equations,  e.g.,  the  Euler  equations  for  angular  mo- 
tion, describe  the  interrelation  between  angular  velocity  and  applied  moments. 

The  measurement  equations  are  assumed  to  be  available  in  the  form 


H,  - V, 


H , X , • V , 


(2-6) 

(2-n 


where  the  measurements  : should  be  relatively  accurate  to  provide  good  information  on 
X7  and  the  n^xni  matrix  H,  should  be  nonsingular.  This  means  that  we  require  relatively 
good  information  on  all  dynamic  state  components. 

Solving  Eq.  (2-'l  for  x,  and  substituting  in  Eq . (2-1)  yields  the  reduced-order 
sys  tem 


- ) 


) I 


- V 


- I 


I : 


(2-Hl 


where  is  a deterministic  input  and  v,  is  now,  in  this  context  "process'’  noise.  With 
Eq.  (--4)  and  IJ-6)  one  can  now  design  a filter  of  order  for  Xj.  This  filter  is  sub- 

optimal  since  it  does  not  make  use  of  the  information  represented  by  E.q . (d-.*!).  However, 
It  does  not  require  precise  modelling  of  the  dynamic  state  equations  which  often  involve 
uncertainties  in  the  parameters  as  well  .in  in  the  noise  statistics;  it  is,  therefore, 
ai.o  less  sensitive. 


f’lac  t 1 c .1 1 I V . especially  for  navigation  systems,  one  often  goes  one  step  further 
•«nd  designs  filters  for  the  so-cnIle<l  <ncte»if«r4  defined  as 


I 


I ; - " 1 


and 


V , 


A,  V,  ♦ C 


(2-16J 


if  V,  is  colored  noise,  we  have  colored  noasurc'icnt  noise,  which  requires  a special 
trea..ment  15).  This  case  is  not  needed  for  fhc  present  application. 


2 . 2 Er»~or  Dynamics  for  Platform  Alignment 


We  now  apply  the  general  considerations  of  Section  2.1  to  our  platform  alignment 
problem:  The  lincarired  kinematic  equations  to.  the  platfor.m  angles  can  he  written  as 
fol  lows  ( 2 ,&] 


■ ■ 

- 

r ' 

r 

3 

0 

l-v 

'■'h 

Cl 

b 

■'•v 

0 

c 

c 

* 

I 

L J 

"h 

0 

0 

I 

L.  ,J 

'I  I 


C-1') 


where  a,  f,  and  n are  the  platform  angles  about  cast-west,  north-south  and  the  arimuth 
axes,  and  p,  q,  and  r ar?  the  ^oi re spond i ng  angular  velocities.  These  equations  could 
be  supplemented  by  the  three  bulcr  dynamic  equations  of  the  type 
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f ( P , i 
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a 

r 

L ^ J 
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Hcwevei,  using  section  2,1,  this  is  not  necessary.  Pccaiisc  of  the  three  platform  moun- 
ted gyros  we  have  g-iod  information  on  the  angul.ir  velocity  components  p,q,  and  r avai- 
l.-bleintheform 
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whe*e  Dp.  Djj,  are  the  total  drifts  of  the  corresponding  gyros  (measurement  noise). 

Using  the  results  of  Eq.  (2<-n),  including  the  fact  that  in  the  present  application  Xj  s 0, 

because  we  measure  the  misalignment  angles  from  the  zero  position,  i.e.,  a s ao,  ...  one 
obtains  as  the  platform  error  equations 


“ • «v  6 - Y ♦ Dp 

B - -Oy  o ♦ (2-20) 

; - «h  “ * K 


where  the  gyro  drift  appears  now  as  input  (process)  noise  to  Eq . (2-20)  (see  Figure  2). 

Information  on  the  platform  misalignment  angles  is  available  through  the  two  plat- 
form-mounted accelerometers.  (Their  output  is  used  in  flight  to  provide  Information  on 
vehicle  acceleration,  velocity,  and  position).  The  accelerometers  are  mounted  in  the 
horizontal  plane,  so  that  their  output  is  (on  ground)  proportional  to  the  misalignment 
angles  a and  6 


g a ♦ Bp 

z,  ■ _ (2-21) 

-g  B * 

where  and  B^  are  the  total  accelerometer  errors  (including  errors  of  signal  trans- 
mitters). 


2 . 3 Noise  Modelling 

If  the  noise  inputs  in  Eq.  (2-20)  and  (2-21)  would  be  white  (known  R)  the  design  of 
the  Kalman  filter  would  be  straightforward  and,  in  fact,  of  order  3 (see  conventional 
gyrocompassing  loops).  Complete  noise  models  are,  however,  more  complex  and  hardly 
avaHable  in  the  literature.  We  therefore  agreed  to  set  up  a test  series  at  lABG  for 
achieving  trustworthy  noise  models  for  the  gyro  drift  of  the  G-200  gyro  and  for  the  acce- 
lerometer errors  of  the  A-200  accelerometer,  those  instruments  with  which  the  LN-3  plat- 
form - used  for  the  case  study  - is  equipped.  The  noise  models  were  obtained  by  deter- 
mining the  autocorrelation  functions  from  the  test,  choosing  simple  models  with  known 
correlation  functions  and  computing  their  parameters  to  match  the  measured  correlation 
as  well  as  possible  (least-squares  fit).  The  results  are  reported  in  [7]  and  are  summa- 
rized in  Sections  2.3.1  and  2.3.2. 

2.3.1  Gyro  Drift  Models 


The  general  drift  model  of  a G-200  gyro  can  be  described  by  a Gauss-Markov  process 
of  the  type  (Figu re  3) 

D = D*d*^  + 'l^*w  (2-22) 

where 

D • bias 

d"^  ” random  ramp 

d"^  ’ correlated  noise 

w wb  i te  no  i se 


One  therefore  can  write  four  state-equations  to  describe  the  total  drift 


d=  * 


who  re 
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- constant  slope  of  the  rar.p, 
= white  noise  generating  d*"  . 


/I  , , T =■  correlation  tine  constant, 
d o 


Rcm/t-^b;  It  shall  be  noted  that  similar  behavior  occurs  in  the  three  channels  except 
there  is  noticeable  correlated  noise  onlv  in  the  vertical  channel. 


If  one  tries  to  take  the  drift  terms  into  account  in  an  ontinal  fashion  as  indica- 


by  Eo  . 
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and  (2-16),  the 

s t a te -veo tor  in  Hq. 

ft-'tates  to 

a 

total  sue  of  13 

components 

) 

a 

a. 

b,.  B - bj,  > ^ 

D + d ♦ w 

e c e 

y-) 

£ 

” »*.  a ♦ 

V 

1)  ♦ d * ♦ V, 

n n n 

i>) 

Y 

c 

w , a ♦ 

n 

^v  * ‘^v  * ‘‘v'^  * " v 

D 

e 

= 

0 

yi) 

m 

0 

(f>) 

m 

0 

(’) 

'^v 

9 

(8J 

- 

s'" 

y9) 

^n^ 

- 

c,/ 

(10) 

d ^ 

V 

• 

(11) 

• r 

fl 

0 

(12) 

• r 

s 

0 

(1.M 

' r 
c 

V 

B 

0 

[2-M) 


The  normal  set  of  parameters  for  all  terms  is  summariced  in  Table  1.  It  should  he 
.lored  that  nominally,  for  the  parameters  of  the  spectral  den  it>  matrix  Q,  high  (pcssi- 
misticj  upper  bounds  arc  taken.  It  is  well  known  that  in  this  case  the  filter  design 
IS  on  the  save  side  and  the  optimal  variances  are  nut  too  optimistic. 

2 .?>  .2  Accclorometer  hrror  Models 

Similarly,  the  results  of  testing  acce Ici ometors  of  the  A-200  type  can  be  siimmari- 
:cd  as  follows 

c . c , 

5 - B ♦ b ’’  ■*  b • b v ( 2 - 2 S ) 


'-I  2 

b , b 


bias 

random  ramp 

CO  1 rc 1 a t f d-no i sc  terms 
wh  i If  no i sc 


Ullsk.ilj 
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Table  1.  Noainal  *at  of  paraaetora  for  case  itudy 


Coafficionts: 

• 5.771  • 10’*  rad/s;  tl^  - 4.4S8  • 10'^ 


Initial  Uncortainty; 

r»s  a(0)  • rws  6(0)  - 0.2®  or 
TBS  r(0)  - 5®  - 6°  sf  0.1  rad  or 
TBS  - TBS  - TBS  ■ O.S®/h  or 
TBS  dy  " 0.15  ®/h  or 
ras  d^(0)  - rms  d^(0)  - rms  d'(0)  - 0 or 
rms  » rms  --  rms  • 5 • 10~*  °/h^  or 
rms  “ rms  - 6 • 10"^  g or 


rad/s;  Ty  ■ 1/oy  ■ 37  ain;  g ■ 9.814  b/s^ 

P (0)  - P«(0)  - 9 • 10"^  rad^ 

Cl 

Py(0)  ■ 10"^  rad^ 

Pn  (0)  " Pn  (0)  " **D  ■ O.S87-10"’’  rad^/s^ 

“e  *^n  “v 

P.  (0)  ■ 2 ' 10"’^  rad^/s^ 

Oy 

P.rCO)  ■ P^r(O)  ■ P.r(O)  ■ 0 

®n  ®v 

“24  2 4 

P r(^)  ■ P t(0)  - P r(0)  “0,5  . 10"  rad^/s 
*^6  ®n  ®v 

Pn  (0)  • Pn  (0)  ’ 3.5  • 10*^  m/s^ 

®e  “n 


Spectral  Densities: 

1 i8  1ft 

Q : « qn  - 0.S6  • lO'^**  1/s  ; qy  - 1.69  • 10’'^  1/s  ; - 1.06  • 10"  1/s 

R ; r^  - r„  - O.S  • 10*^  m^/s^ 


For  each  accelerometer,  the  total  error  can  be  expressed  by  five  state  equations 


B • 0 


Also,  to  take  this  noise  into  account  in  an  optimal  fashion,  one  has  to  extend  the 
state  vector  of  F.q.  f2-24)  by  10  more  state  components  for  and  B^  and  arrives  at  a 

total  state  vector  with  23  components. 

The  level  of  the  white  noise  docs  not  only  contain  the  accclerometei - instru- 
ment error,  but  also  the  signal-transmission  error,  which  in  this  case  is  dominant 
[6J.  The  significant  values  arc  again  given  in  Table  1. 


2 . t Selection  of  a Design  Model 

The  goal  of  the  state-estimator  design,  in  tlic  present  case,  is  to  provide  imlica- 
tion-i  of  the  physically  interesting  values,  i.e.,  the  misalignment  angles  i , r and  >. 

Their  estimates,  5,  and  y should  he  as  close  as  possible  to  the  exact  values,  keeping 
also  in  mind  the  effort  for  implementation.  In  this  context,  the  extra  states  are  to 
he  considered  as  auxiliary  quantities,  which  theoretically  need  also  to  he  estimated  to 
provide  optimal  values  for  the  angles,  hut  arc  not  of  prime  interest  in  themselves.  Thus, 

* A' si  f^r\'r\\( 
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in  theory,  the  optinal  filter  Is  of  order  23,  equal  to  the  order  of  the  total  process 
(see  Bq.  (2-1.3)  and  (2-3)). 

However,  this  would  not  be  economic,  mainly  because: 

(1)  Some  of  the  terms  nay  be  trken  into  account,  whose  Influence  on  the 
system  behavior  Is  not  sisnlflcant. 

(2)  Some  terns  may  be  not  observable  and  there  may  be,  therefore,  an 
estimator  of  lower  order  yielding  the  same  accuracy  as  the  full-order 
Kalman  filter. 

We  consider  first  terms  of  the  first  kind  and  suggest  that  they  be  neglected  for 
the  estimator  design.  This  procedure  will  ultimately  be  Justified  by  analyzing  the  re- 
sulting filter  on  the  full  scale  model,  (Section  4.2). 


2.4.1  Negligible  Drift  Components 

Ke  have  already  noticed  that  there  were  no  noteworthy  correlated  drift  components  in 
the  horizontal  axes. 

Secondly,  the  random  ramp  components  - theoretJ c.il ly  growing  unbounded  - are  of  mi- 
nor influence  during  alignment  times  of  interest  in  the  range  of  3 to  15  minutes.  For 
these  timespans  their  rms  values  are  one  to  two  orders  of  magnitude  smaller  as,  e.g., 
the  bias  terms.  Therefore  all  random  ramps  are  neglected  In  the  design. 


2. 4. 2 Negligible  Sensor  Errors 

It  follows  from  the  parameters  of  the  test  results  that,  as  in  Section  2.4,1,  the 
random  ramps  are  very  small,  which  in  this  case  is  also  true  for  the  correlated-noise 
terms  as  compared,  e.g.,  to  the  bias;  they  can  therefore  be  neglected  without  hesitation. 

The  relation  of  the  level  of  the  bias  to  the  level  of  the  white  noise  depends  on 
the  quality  of  the  signal  which  can  be  tapped  at  the  platform.  For  the  noise  level  in 
the  nominal  case  (Table  1),  the  bias  terms  and  seem  to  be  negligible.  However, 

for  the  north-so.uth  accelerometer  at  the  analog  navigation  computer  of  the  LN-3  platform 
a signal  of  higher  quality  could  be  tapped  (leading  to  a lower  value  of  r^) 


rms  a 7 X t0‘®  g or  r^  » 0.5  x 10‘®  m*/s^  (2-27) 

In  this  case  the  bias  (maximum  6 x 10”^  g)  is  not  negligible  any  more.  Therefore  depen- 
ding on  the  situation,  we  may  or  may  not  neglect  the-  accelerometer  bias,  especially  B^. 

In  conclusion,  we  arrive  at  the  following  design  model: 
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McAsi'reBont  Bias: 
(8)  " 0 

(9)  - 0 


3.  FILTER  DESIGN  AND  REDUCTION  OF  ORDER 

After  all  of  these  preparatory  considerations,  we  now  enter  the  actual  filter  design. 
The  most  important  requirement,  expressing  the  filter's  ability  to  reduce  the  estimation 
error  as  compared  with  the  unfiltered  process  (see  Eq.  (2-28)  and  (2-30))  Is  the  observa- 
bility of  this  process  under  the  observations  (see  Eq.  (2-29))  [1,5].  The  problem  of  ob- 
servability can  partially  be  treated  by  deterministic  means,  i.e.,  it  is  a structural 
property  expressed  by  the  matrices  F and  H.  However,  this  does  not  answer  the  question 
of  how  'well*  certain  quantities  can  be  determined.  The  latter  can  only  be  answered  by 
stochastic  means.  We  shall  handle  both  problems  which  both  give  rise  to  order-reduction 
in  this  section. 


(2-30) 


3. 1 Consequences  of  Restricted  Observability 

In  most  cases  of  filter  application,  one  is  faced  with  the  fact  that  a given  process 
is  not  completely  observable,  especially  if  - as  is  the  case  here  - noise  models  are 
added  to  the  phys’cal  quantities,  ihe  best  insigh;  in  the  consequences  for  the  filter 
design  is  obtained  then  by  transforming  the  original  system,  Eq.  (2-1)  and  (2-2),  to  (ob- 
servable) canonical  form  (S]  via  the  linear  transformation 


Tq  X 1 


“l 

\ L 

q 

0 

1 I 

, n-q 

(3-1) 


This  brings  Eq.  (2.1)  and  (2-2)  into  the  form 


y,  • A,',  y,  ♦ B,  w 

Y2  " A,,  y,  ♦ Aj2  X2  ♦ w 
z - C,  y,  ♦ V 


(3-2) 

(3-3) 


Here  y^  is  observable  (q  terms)  and  Yi  unobservable  part  (n-q  terms).  Note  that 

the  nonobservable  part  of  the  state  vector  remains  unchanged  by  the  linear  transformation 
y,  ■ (pussibly  after  reordering,,  whereas  the  observable  quantities  y^  are  linear  com- 
binations of  th'  original  states  Xj  and  the  unobservable  states 


y,  • X,  •»  L X,  (3-4) 

Formal  application  of  the  filter  equations  (Eq.  (2-3))  to  Eq . (3-2)  and  (3-3)  yields  (see 
Figure  4) 

V;  - A,,  y,  * K,(t  - C 

y.  • A,,  y,  ♦ A,,  y,  * - C 

If  wc  denote  the  covariance  matrix  of  the  transformed  system  hy  n 
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(3-5) 


U (y-y) (y-y)  ) 


”11  '^12 

^2  ^’2 


wc  can  f r, rmi.  1 .1  tc  the  properties  (51: 
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(')  The  proble*  of  esti««ting  the  qx1  vector  y,  can  bo  trotted  toptratoly  as  neither 
yj  nor  n,2  or  nj2  needed,  and 


U) 


(3) 


T , 1 

"n  c/  R 


(3-7) 


The  filter  for  y^  Is  of  order  q. 

The  estimation  problem  for  y^  • X2  depends  cn  and  Hjj.  Thus,  this  may  in- 
fluence the  accuracy  of  X)  via  Xj  • y^  - Lx2>  "ery  often  it  is,  however, 
sufficient  to  let  x^  >»  y^  and  abandon  the  estimation  of  X2. 


It  is  questionable  whether  the  overall  filter,  Eq.  (3-S)  , is  stable.  In  fact, 
it  is  not  stable  if  A22  is  not  stable  from  the  outset  [5].  If  A22  is  stable, 

the  system  is  called  "detectable"  and  the  resulting  filter  is  stable. 


At  DFVLR  we  have  developed  a computer  program,  which  transforms  a general  given 
system  of  the  type  of  Eq.  (2-1)  and  (2-2)  into  *■*  j canonical  form  of  Fq . (3-2)  and  (3-3); 
it  provides  the  number  of  observable  states  and  their  dependencies  on  the  unobservable 
states,  i.e.,  the  matrix  L in  Eq.  (3-4). 

In  the  present  case,  it  is  also  possible  to  decide  0.1  obcv .vaMl ity  analytically; 
this  allows  an  independent  check  on  the  numerical  results  and  more  clearly  provides  the 
dependencies  on  the  general  parameters.  The  idea  is  to  use  the  measurement  equations 
and  their  time  derivatives  inserted  in  the  differential  equations  and  then  to  solve  lor 
the  states  it  possible.  Usually,  the  more  differentiations  that  are  needed  for  a state, 
the  poorer  are  its  estimates.  However,  precise  quantitative  answers  are  obtained  only 
from  a covariance  analysis. 

3 . 2 Observability  Analysis 

3.2.1  Observability  of  the  Drift  (B^  r s 0) 


It  can  be  shown  that  the  observable  quantities  are 


with 


la.  B,  Y,  D^,  Dy.  dy] 


(3-8) 


The  observable  subsystem  is 
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It  ! - I’v  '.ecn  that  all  quantities  in  Iq,  f5-n)  are  ohscrvahle;  however,  The  csti' 
of  the  a;i:o'ifh  aaglc  ,,  using  7,  is  cont  .sm  i na  t ed  hv  an  iinohse  rvah  1 o bias  of  the 
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5.2.2  Observability  of  the  Accelerometer  Bias 

If  the  accelerometer  biases  and  are  not  negligible,  estimation  of  them  could 

K*  considered  to  reduce  their  Influence  on  the  accuracy  of  the  misalignment  angles.  Thus, 
It  needs  to  be  Investigated  whether  these  quantities  are  observable. 

It  can  shown,  however,  that  the  ooservable  subsystem  remains  of  order  6 as  in  Eq. 
(5-9).  That  is,  the  two  additional  states,  and  B^j,  Eq.  (2-29)  and  (2-30),  are  not 

observable.  In  fact  the  observable  states  are  now 


(1)  i 

(2)  8 

(5)  ; 
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(65  3^  ■ dv 

Unobservab'.e  are  D_,  B_  and  B , which  means  that  an  estimator  of  order  b is  most 
e e n 

likely  to  provide  the  same  estimation  accuracy  as  would  an  estimator  of  order  9. 


3 . 3 Proposed  Low-Order  Filter 

The  structural  considerations  of  the  previous  subsections  are  still  somewhat  ab- 
stract since  they  do  not  allow  the  question  of  how  good  the  estimates  may  be  to  be  ans- 
werea.  Quantitative  statements  of  this  kind  are  reserved  for  the  optimal  filter  and  its 
accompanying  covariance  equation  of  the  Riccati  type.  We  therefore  computed  a variety 
of  optimal  covariances  to  develop  a nominal  filter  of  minimal  order. 

In  order  to  confirm  the  statements  of  Section  3.2  we  ran  the  full  size  filter  for 
all  nine  states  of  Eq.  (2-23)  anJ  (2-29).  In  addition,  this  filter  has  the  advantage 
of  setting  the  standard  for  comparison  with  all  other  filters  because  it  provides  the 
minimum  possible  variances  for  all  states. 

The  results  can  be  summarized  as  follows: 

(1)  The  variances  of  the  unobservable  states  D^,  B^  and  remain  constant  as  expec- 
ted. Thu< , it  does  not  pay  to  keep  these  states  in  the  filter. 

(2)  The  variances  of  the  misalignment  angles  about  the  horizontal  axes  decrease  very 
rapidly  to  small  values  (see  Figure  S).  This  behavior  is  due  to  the  fact  that 
direct  information  for  a and  6 is  available  through  the  accelerometers.  The 
stationary  variances  are  predominantly  det'-rmined  by  the  level  of  the  (white) 
accelerometer  noise;  only  in  a docs  the  variance  continue  to  decrease  slightly 
due  to  the  improvement  in  the  drift  estimates  (B^^)  . 

(3)  The  azimuth  estimate  r has  to  be  determined  through  the  dynamic  equations  (no 
direct  measurement)  and  thciefore  does  not  decrease  as  rapidly.  It  reaches  its 
stationary  value  after  about  30  or  40  minutes  (Figure  6). 

fl)  The  estimation  of  behaves,  qua  1 i t .at  i vel  •/ , similarly  to  y.  Its  variance  de- 
creases to  small  values  after  a few  minutes  (Figure  ■■)  . Iheo  re  t i ca  11  y , I'^  can  he 

estimated  exactly  (no  process  noise);  however,  the  stationary  filter  would  not 
he  s f ab Ic  ( 3 ] . 

'(3)  The  estimate  of  improves  still  more  slowly  (in  agreement  with  the  necessity 

of  taking  higher  derivatives  of  the  measurements  as  explained  in  Section  3.2), 
and  the  improvement  in  is  almost  not  recognizable  within  the  Interesting  ob- 
servation interval  i3  to  20  minutes)  (Figure  8). 


■J-l  I 


As  a result,  it  seems  worthless  to  keep  the  state  n^,  in  the  filter  - it  is 

very  weakly  observable  within  the  time-interval  of  interest.  The  resulting  filter 
is  then  of  order  5 and  has  the  term 
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The  following  simplifications  may  be  considered; 

(1)  Depending  on  the  observation  interval,  the  consequences  of  leaving  off  ..he 
states  d^,  and  finally  ma>'  be  investigated  (Section  4.2;. 

(21  Some  of  the  gains  can  be  approximated  by  constant  or  p i eccw  i se -cons»t  an gains. 

(3)  Moreover,  the  continuous  filter  may  be  - for  ease  of  implementation  - approxi- 
mates by  a discrete  filter  (6]. 


In  any  event,  the  continuous  filter,  as  discussed  above,  sets  the  stand.irds  for  com- 
parison . 


4.  ANALYSIS  OF  THb  PROPOSED  FILTER 

As  we  have  seen  in  the  foregoing  discussions,  there  are  a variety  of  reasons  why  the 
model  used  in  the  filter  differs  from  the  real  model.  Some  of  these  arc: 


(1)  Insufficiencies  in  the  model  itself  resulting  from  varying  and  unknown  parame- 
ters. 

(2)  Neglecting  quantities  which  do  not  seem  to  have  significant  influences. 

(3)  Neglecting  unobservable  or  wcrkly  observai^lc  states. 

(1)  Approximate  gains  for  implementation. 


In  all  of  these  cases  the  accompanying  optimal  covariance  matrix  is  suspicious  because 
it  is  based  on  the  simplified  model  (se 1 fdi agnos t ic 1 (3).  A remedy  to  this  situation  is 
a complete  covariarce  analysis  of  the  filter  design  on  the  real  system,  model  and  the 
applied  gains.  Such  a covariance  analysis  can  be  performed  as  long  as  the  exact  sys.em 
can  be  linearized,  which  is  certainly  true  for  fine  alignment.  To  get  answers  of  any 
statistical  value  from  simulation,  many  expensive  simulations  and  evaluations  would  have 
to  be  performed. 

ip.  any  event,  a finai  experimental  verification  is  always  appropriate  1 ft  I . 


4 , I General  Program  foi  Filter  Covariance  Analysis 

The  aforementioned  covariance  analysis  can  be  performed  as  follows: 
(1)  Let  the  design  model  for  the  filtei  he 
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where  for 

and  V spectral  densit;  matrices  Q,'  and  arc  assumed, 

leading  to 

an 

optimh.'  filter  for  the  nomirial  values  of  the  form 
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The 

actual 

sy s tern, 

howe . er , 

is  assumed  to  be  described  by 

■ f^ll 

X,  ♦ F, 

, X2  ♦ Gi 

“l 

(4-4) 
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X,  . F, 
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(4-6) 

where  w, , and  v actually  have  spectral  densities  Qj,  Q,  and  R respectively. 

(3)  The  deviations  of  the  design  oaramcters  froni  the  system  parameters  are  defined 
as 


aF 
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(4-7) 

(4-8) 


(4)  Finally,  the  covariance  of  the  estiration  error,  x,  = x,  ■ x,,  resulting  froj' 

using  the  filter  l-q.  (4-3)  at  ti.e  process  Fq.  (4-4)  through  (4-6)  is  to  be  com- 
puted from  the  following  set  of  equations 


F X ♦ ,X  f’’’ 


G Q 0 


..T 


(4-9) 


;■  U + U ( r 1 1 * ^ 1 'I  ] ) 


X(CF,  , - K,  .',H, 


G,  Q,  G, 
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t1 


F|,  - K,*  H,)''' 


(4-10) 
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T, 
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IJ 
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9 

X - F(x  x^ 

'll 

'l2 

. c 

0 

'zi 

'2: 

G 1 

(4-11) 


Q, 


Remaxti  : 

(!)  The  filter  gains  used  in  l.q.  (4-5)  do  mt  need  to  result  Iroii;  an  optical  filtv 
design  for  I.q  . (4-l)  and  (4-2),  in  favt,  they  can  l>c  any  gains  ( t i me  - va  ry  i ng  or 
ronstant),  used  in  the  actual  filter. 
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Ren'a'iti  (Co'it. ) : 

(2)  Note  that  Eq.  (4-9)  through  (4-11)  are  coupled  in  one  direction,  i.e.,  X.  The 
covariance  of  the  process  without  filtering,  from  Eq . (4-9)  is  used  ..o  obtain 

U via  Eq.  (4-10)  and  finally  U is  needed  in  Eq . (4-11)  to  compute  the  error  co- 
variance  of  the  estimate  x^. 

(3)  Note  also,  that  for  exact  system  order  and  parameters  (bF,]  - 0,  iHi  • 0)  only 
„q.  (4-1))  is  needed  and  reduces  to 

S ■ (F  - K*  H)  S ♦ S(F  - K*  H)'*'  ♦ G Q ♦ K*  R (4-12) 

i.e.  , a set  of  linear  equat'ons  for  given  K*.  Furthermore,  Eq . (4-i2)  is 
identical  to  the  Riccati  equation  for  K*  • PH‘  R"  , i.e.,  for  optimal  gains. 


The  general  approach  presented  in  this  section  is  used  in  the  following  for  two 
purposes:  first,  for  verification  of  the  filter  reductions  by  choosing  the  design  model 

of  Section  2.4  and  the  observability  consequences  of  Section  3.3;  and  second,  investiga- 
ting the  filter  sensitivity  on  parameter  changes. 


4 . 2 Filter  Reduction  via  Covariance  Analysis 

To  verify  the  previously  mentioned  reductions  of  order  and  to  investigate  possible 
further  reductions,  an  extensive  covariance  analysis  was  performed:  first,  with  refe- 

rence to  the  design  model  of  order  ? and  nominal  parameters;  second,  the  resulting  fil- 
ter was  analyzed  cn  the  full-site  model  of  order  IS. 

The  following  cases  were  considered: 

(1)  A seventh-or ier  filter  for  a,  6,  y,  , 0^,  dv 

(2)  A sixth-order  filter  for  a,  S,  y.  Ej,  ■ , d^ 

(31  A fifth-order  filter  for  S,  y.  (or  d^) 

(4)  A fourth-order  filter  for  a,  fl,  y. 

(5)  A third-order  filter  for  a,  6.  Y 

The  analysis  was  performed  on  the  design  model  and  considers  in  each  case  the  in- 
fluence of  all  neglected  quantities.  Tne  results  are  summarized  in  Table  2 and  in  the 
following: 

(1)  The  seventh-order  filter  prc”ides  the  bounds  for  the  reachable  accuracy  and  serves 
as  the  reference  for  evaluation. 

(2)  It  is  very  interesting  to  note  that  the  following  filters  of  order  6 to  4 provide 
the  same  accuracy  as  the  seventh-order  one  in  the  remaining  stales.  (However,  their 
selfdiagnostic  is  too  optimistic,  as  expected.)  For  that  reason,  it  is  - at  least 
for  the  short  estimation  interval  of  3 minutes  - most  efficient  to  implement  only  a 
filter  of  fourth-order.  If  longer  duration  for  fine  alignment  is  allowed,  or  if 
larger  values  of  the  (observable)  drift  components  have  to  be  considered,  a sixth- 
order  filter  can  provide  improved  estimates  on  , 0^ , and  d^ , and  reduce  their  un- 
desirable in^'l'ierce  on  the  estimates  nf  a and  «.  However,  a noticeable  effect  duriiig 
an  interval  of  10  'ninutes  occurs  only  in  estimating  and  its  influence  on  ft  (see 
Table  2).  The  quantities  ar.d  especially  dy  can  only  be  estimated  if  a very  long 
observation  time  were  allowed. 

13)  A further  reduction  to  a filter  of  third-order  seems  not  to  bt  appropriate  in  com- 
parison with  the  results  for  the  fcurih-order  filter;  the  accuracy  of  the  estimate 
of  3 deteriorates  s ign  i f i cant  Is-  (see  Table  2). 


j 


.3 

1 

] 

I 


As  a result,  a f mirth-ordcr  filter  seems  to  be  the  best  compromise  between  estima- 
tion accuracy  and  cx,nerdi  turc  for  imp  1 ementa  i ion  . 


In  order  to  verify  that  all  neglected  quantities  are  real’/  negligible,  wc  analyzed 
t I.e  proposed  fourth-oi  der  filter  or.  the  full-size  model,  taking  inlo  account  all  drift 
components,  i.e.,  Lq . as  well  as  the  accelercmetcr  bias  terms,  Eq . (2-30). 

Tile  results  prove  the  validity  of  the  preceding  reductions: 

Is'ithin  an  estuiation  pencil  of  at  least  up  to  Is  minutes  the  random  ramps  arc  negli- 
gible. Their  inclusion  would  not  in  any  respect  improve  the  estimates. 

(2)  The  unobservable  bias  terms  He.  he,  and  H,,  do  coiitrihute  to  t be  estiiaation  error. 

However,  t be i r inclusion  in  the  filter  would  not  bring  any  advantage  because  of  the 
filter's  inability  te  reduce  their  unce i t a i nt i cs . 
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The  difference  between  the  previous  seventh-^order  analysis  and  the  present  one  is 
due  only  to  the  accelerometer  bias  terms.  X^®  trror  variances  of  a and  S ore  higher  by 
exactly  these  sensor  biases  (0.56x10*8  rad^).  The  influence  is  still  modest;  about 
30\  after  3 minutes  and  a factor  of  2 after  10  minutes  in  the  a and  6 variances;  no 
change  at  all  in  y. 

The  situation,  however,  changes  significantly  if  the  noise  level  of  the  accelc''ome 
ter  is  lower,  as  /e  shall  sec. 


4 . 3 Analysis  of  the  Proposed  Filter  Under  Parameter  Uncertainties 

To  locali’e  the  sensitivity  of  the  filter  with  respect  to  parameter  uncertainties, 
onl)  some  of  the  parameters  were  changed  in  each  of  the  following  cases. 

4.3.1  Variation  of  the  Drift  Time  Constant 

The  nominal  value  of  the  drift  time  constant  is  tJ  • 37  minutes;  the  variation  about 
this  value  can  be  as  big  as  i 20  minutes  (7).  Of  most  significance  could  be  the  variation 
tc  lower  values,  since  fcr  higher  values  the  drift  d,.  approaches  a bias.  It  was,  there- 
fore, investigated  how  a filter  (designed  for  T*  • 3.  minutes)  behaves  if  actually 
Ty  • 17  minutes. 

As  expected,  the  result  was  as  follows:  the  analysis  of  the  seventh-order  filter  on 

the  seventh-order  process  yield.d  a slight  change  only  in  the  estimate  of  dy ; all  other 
er^’ors  remained  unchanged  in  the  relevant  figures;  this  was  also  the  case  for  the  low- 
order  filters  down  to  order  4.  i'he  reason  for  this  behavior  is  due  to  the  fact  that  the 
time  constant  of  the  dr’ft  is  still  relatively  large  with  respect  to  the  observation  time 
and,  moreover,  the  effect  of  d^.  on  tnc  physical  quantities  i,  modest. 

4.3.2  Variation  of  the  Drift  Noise  Level 

Because  upper  bounds  were  assumed  for  the  drifts  in  the  previous  cc ns i de ra t i on? , the 
results  obtained  are  on  the  pessimistic  side,  i.c.  if  tie  actual  drift  level  is  lower, 
the  filtei  nay  »llow  better  accuracy  as  indicated  so  far.  Especially,  if  the  spectral 
densities  (Q-matrix)  are  nominally  set  fairly  high.  Thus,  we  investigated  two  cases; 

Ca.il  I:  Lowering  the  spectral  density  parameters  by  a factor  of  but  keeping  the 

initial  variances  of  the  drift  to  their  nomin"*.!  values.  This  corresponds  "o  an  uncaii- 
brated  platform  with  rather  big  bias  terms  (0.3  °/h) . 

Can  2:  Lowering  in  addition  the  bias  I)g  to  0.04  °/li,  corresponding  to  a calibrated 

platform.  This  value  could  also  be  achieved  for  a noncalib. ated  platform  by  the  follow- 
ing procedure;  Turn  the  whole  platform  so  that  the  e-st-’,cst  gyro  bec9mes,.a  north-sculh 
gyro,  i.e.,  -•  Dp' ; estimate  the  north-south's  gyro  drift  Up,  i.c.  C,  = Up  for  some  minutes 

and  turn  the  platform  to  its  normal  attitude.  ‘‘ 

The  results  are  sumir.a  ri  ted  in  ’'"able  3;  there  is  no  significant  change  in  the  accu- 
racy of  a and  6 as  compared  with  the  nominal  case.  This  is  not  surprising  since  their 
error  mairly  depends  on  the  accuracy  of  the  act e 1 erome te r . The  atimuth  estimate  is  im- 
pioved  slightly  in  Cese  ).  Tt>e  site  of  the  spectral  density  Q is  already  such  that  its 
influence  on  the  state  estimates  is  modest.  This  was  confir.ied  by  letring  Q • 0 and 
still  having  about  the  same  results.  Significant  changes  in  the  azimut-  estimate  are, 
however,  recorded  in  Case  2,  where  the  acirauth  error  variance  is  improved  after  3 minutes 
by  one  order  of  magnitude  and  after  10  minutes  by  i eo  orders  of  magnitude  as  compared  to 
the  nomi.ial.  This  result  is  caused  by  the  fact  that  the  unobservable  drift  Up  which  rests 
upon  Y is  much  lower. 

4.3.3  Variation  of  the  Accelerometer  Noise  Level 

Last,  but  nut  least,  the  influence  of  the  acce  1 c-l  omt  1 1 . nuiSe  level  on  the  filter 
accuracy  was  in'- es t i gated . This  is  of  special  interest,  since  it  is  expected  that  tne  de- 
pendency 15  very  significant  and  accelerometer  signals  of  different  quality  arc  availabir, 

Eq.  (2-2:'). 

The  results  were  computed  with  the  low  values  in  the  drift  as  previously  described 
and  can  be  summarized  as  follows  (see  Tabic  4); 

The  strongest  influence  to  be  recorded  is  on  the  accuracy  of  estimating  u and  fi,  in 
fact,  chc  optimal  filt.r's  variances  are  direct  proportional  to  K (sec  Table  4).  The  in- 
fluence on  the  accuracy  of  the  azimuth  estimate  is  not  as  hig. 

It  is  very  interesting  to  note  th.it  the  filter  designed  with  the  incorrect  values 
(R  ) and  analyrea  with  the  correct  values  (R)  does  not  deteriorate  significantly.  That 
is,  even  if  the  design  values  for  the  noise  arc  set  wrongly  (at  R ) and  the  real  values 
are  higher  (at  R)  the  filter  is  stili  able  to  provide  almost  optimal  estimates  (sec  Table  4). 

Also,  an  act  el  c ro.ae  t c r bias  of  (>  10'^  g may  no  Icn'"  be  negligible.  Therefore  we 

added  this  bias  to  the  error  budget  tor  Case  1,  leading  c ons  i dc ''ab  1 y higher  error  va- 

riances lor  a and  p (sec  Table  4).  l.s,>ccially  with  resp.ct  to  u,  it  docs  not  pay  to  search 
for  improved  signals  in  Vp  (wb.ite  noise)  as  long  as  we  have  to  dcel  with  the  abovc-m-r 
tioned  bias.  in  this  case,  the  bias  determines  the  level  of  the  error  in  o. 


Table  3 Error  variances  for  variation  of  drift  noise  level 


S.  RESUME.  EXPERIMENTAL  VERIFICATION,  AND  FUTURE  INVESTIGATIONS 
S. I Rasuat 

This  presentation  demonstrates  the  steps  to  be  taken  to  design  low-order  efficient 
state  estimators  for  the  problem  of  fast  and  fine  alignment  of  inertial  platforms.  The 
characteristic  features  of  this  study  can  be  summarized  as  follows: 

(1)  The  investigation  is  based  or.  a thorough  modelling  of  gyro  drift  and  accelerometer 
noise.  The  stochastic  models  are  determined  -through  evaluating  extensive  series 
of  tests. 

(2)  The  overall  system  dynamics  is  formulated  within  the  framework  of  kinematic  modell- 
ing leading  to  a reduced-order  filter,  which  is  insensitive  with  respect  to  certain 
parameters. 

(3)  For  the  relatively  short-term  operation,  in  the  present  problem  only  some  of  the 
identified  components  of  the  noise  models  have  significant  influence. 

(4)  An  observability  study  in  connection  with  an  investigation  of  the  filter's  own  co- 
variance  behavior  proves  to  be  a source  of  further  reductions. 

(5)  Finally,  a complete  covariance  analysis  is  performed  to  check  whether  the  suggested 
simplifications  are  allowed  and  to  investigate  the  filter's  reaction  to  certain  pa- 
rameter variations. 

From  the  numerical  results  we  can  draw  the  following  conclusions: 

(1)  It  is  sufficient  to  implement  a fourth-order  filter  for  a,  S,  y , and  Djj,  since  addi- 
tional components  are  either  not  observable  (D^,  Eg,  and  B^)  or  their  error  variance 
is  not  significantly  reduced  within  the  observation  time  in  the  range  of  3 - 10  mi- 
nutes (Dy  and  dy) . 

(2)  The  influence  of  the  gyro-drift  parameters  show  that  the  resulting  filter  is  rather 
insensitive  with  respect  to  the  variation  of  these  values. 

(3)  The  estimation  accuracy  depends  largely  on  the  size  of  the  accelerometer  noise  level. 
However,,  it  is  surprising  that  a filter  designed  with  incorrect  values  for  this  noise 
does  not  deteriorate  significantly  when  compared  to  the  optimal  filter. 

(4)  Typical  error  reductions  in  the  alignment  angles  are  almost  two  orders  of  magnitude 
in  o,  6 and  y within  3 minutes  of  operation.  It  has  to  be  taken  into  account  that 
o,  B are  already  much  better  known  at  the  beginning  of  the  fine-alignment. 

S . 2 Experimental  Verification 

To  verify  the  theoretical  considerations  the  following  test  configuration  was  set  up 
at  the  DFVLR  laboratories  in  Braunschweig; 

An  LN3-platform  was  opened  to  read  the  outputs  of  the  two  horizontal  accelerometers. 
These  signals  were  fed  into  the  Kalman  filter;  the  filter  was  approximated  by  its  discre- 
te pendant,  which  was  programmed  on  an  EAI  Pacer  100  process  computer.  Due  to  the  esti- 
mates provided  by  the  filter,  torquer  signals  were  applied  to  align  the  platform  to  its 
nominal  attitude.  To  read  out  the  exact  misalignment  angles  for  comparison  with  those 
indicated  by  the  filter,  the  platform  was  opened  and  a mirror  was  attached  whose  posi- 
tion can  be  recorded  with  the  help  of  a collimator. 

The  first  encouraging  results  of  the  experimental  verification  are  available  [6]. 
Details  will  be  shown  in  the  oral  presentation. 

5 . 3 Future  Investigations 

Future  investigations  will  include  the  influence  of  prefiltering  of  sensor  data,  the 
incorporation  of  temperature  models  for  the  noise  terms  as  well  as  tests  of  the  complete 
system  within  the  vehicle. 
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